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{54) GAIT PATTERN GEMERATING DEVICE FOR LEGGED MOBILE ROBOT 



(57) A gaii geoemtion system of a iegsed mobile ro- 
»ot, In partfetitar a biped robot that has ttte cfjfnamic 
rnadei sxpressing 8ia refation.'shfp between the motion 
of she body and leg ancS tha floor reaction force, and pro- 
visionally deterrnirjes ihe current time q-aH parameters 
inciuding at feast psfarrjotefs that delsfmsns teg tfs|ec- 
tOfyiiodthe ik& in rasponse » a dramand, supposes tfie 
parameters of a periodic gait, corrects th® current time 
gait pararrieters such that me body irajsctoiy deter- 
mirtsjd frotrs tne dynamic model and the parameters of 
the euri-Bf-i time gait, eic. , converges io a boay tf ajecio. y 
determined from the parameters of fhepsriociic gait, arid 



dstemiinas instsntaneosjs vaiiias of she current time gast 
based on the corrected current time gait parameter, With 
this , the systen:^ can gsnerates a gait of any stride, tum- 
tr>g angle and walking period, including the ftoor reaction 
force acting on the legged mcbife robot, that satisfies 
the dynamic eqyfjibrf«rri condition Further, the system 
can genorfites 3 gait In such a maimerjhai ihecJiSpiace- 
.men; and veiocity of each ra&ot part are continues at the 
boundary of ttie genersied gait and that syceeading 
tijeroto, can generate a gail thijf is fiigh in the margifi o( 
sSabiiiiy, cafi predict -uturs bef)ayior ot the robot snci 
generate a gait such ihatnodissdvarstages such as pos- 
ture divargence occurs. 
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DeseriptSon 

TSCHhiiCAL FtSLO TO WHiCH THE INVENTiON HEUC>tB TO 
. roo013 The present invam^o. « .0 a gair generation system ot . iegga. mo«.o robot, mor. p..^c...rly to 
a sysL^ tor genof^img or deieftr.«HPg a gaiv fmeiy o« a real time basts. 

BACKGROUND ART OF THE iNVENTfON 

walking period. _ . . inrffcates a situation where a m P determirifid 

,0 rom the gravity mm force o1 a desired gart is equai J J^^f^f;^^^,^;^^^^^^ .ero. Hera, tho 

ZMP (Zero Moment Poini) indtoatas a floor p{«m at ^hich me e.u . . , u ^^^^^^^^ 

««d the gmvity intarsect the«eor. Mor. P-t^Sl^S ^ .^"^^^^ component. 

resultant tore* ot the i«ertial fo«e mduced by J;':^^:;^^:-';:;;,;^,^ turn a desired ZMP W Sarge from 

55 190051 Further, in 5he proposed icc.in.cjur^, 6,nc.' ^ . ..n . . ..^^ ..-^^ boundaiv of a gaa of a walking 

its expected trajectoty so as to bnng both the i>ooy p..».o.. 'j^ 

step and that succeedins thereto. ^!";Xr^Smii"«he^o^^ 

[00061 Further, ir, ordertc reastze various br<c4s of vvaiK..,9, P-°P°^^" JL ^^^r/. Furthermore, a set of 
Lrd .Irtime-senes data to b. .tcred .nd .e^.^ n^^^^^^^ 
» standard gaits muM be prepared er> ar> off -ime =<^"^f;f^2riaSrfe ^i^'^'i^^ "^^^^^^'V' 

, gait that is qusse different from ths standard g^. m^ ^^^^ 1 " L^^^^^^^ s'^'^f^ 
P007J Mid. trom the above, since gait the <Jyn«n* .y.i.m 

[Siaffts typical robot dynamic rr^odofe, fcitowir^g t«« r«odeis are known. 



1 ) a r5iode! assigned with a single materw) point , jao -^ce '"c^aip' i 

2) a rrjodei assigned wUh nwtepie matenrff potnis iD.u, r.,^.c(,.x\ iot^ 



10013] c s ngie -nat^s ■> "-^ ; ^ "^^^ ^ , t ^ , „ oniy «>et at its 

proposea technique, the robot is modet as a s« "^alc^ at ^o'^' ^ ,^ do$erffi>ne 

body to ensufs iineanty such lhai ii is crnnm iht? w<iy noight v..^ .on....>t. 



2 



roDos beftavtoc anaiyticadi? 

{0014} Since »!«Wpwjroho{Jf.t»- ^.i..,.,.^.. 

* f> ' g , ^.,>o'ti,P - ' ' '"'***'9''''''^*^*^Sfsscticn force can be fisgiscrsd 

it» ieg is so ia-'getna! a cm nDt'oTnegior^od T.^^^' ^1^^^^ f*umanota type, strtce the mass of 

SGCuracy of approxtmajion wHi accordingiy aaqra'^s 1 i-.''''t^«^f V!-""^^^ '^'"'^'^ '"^ '^^ humanoid type robot, Shs 
a high speed. ' ' " ^ ■ •• ''•ay. wc>-se, turn over »? cofttfoiiMi to waik at 

moti"'- «n U.^.own Unevc-n S..^a..» (Jou.^a! of Jhe Rotates Scdety ot jLan r^!^ 
D!S'DLOSUne OF THE t.WENTION 

techniques ,T.snE»oaed ,^ov8 -nd 1^0X2 ^nSt '^'^'^^'^'^^^P'^^'r^otM^Uno^i^ 
m U^iudin^i '.^t^f SSulf^;^ ^.'^ ^ ^ generate a 

on a r««i.t«^%a«. m .Zl^^X^^^^^ ^ ^ ^ «*« freely and 

tfie prior art model simpfifcationt_c-nq,-^s . " ^ '^^h-ia^c propcssti eariisr and 

fofoo! Which can genera a Saii of the tegqedrriobite'mboti^^^v 

a dynamto mod«jl«iai expresses feia'ionsh!»be^v^f^--^,n<ion ,f u t^ 

tin,, gait parameter p<J,M.-6^t,.^^'^:^: ZT- v' ? Tf "'^ ' '"'^^ r^^aotion.f^rce; ourmal 
including at teasi p^cn determining a. Jie^ryVthyre<,tr^^^^ ™^ «^ 9a» 

ce«o,ng to ihe cwsmtime gait in ^spoRse to at teasJ the der,.«.d. -ron^ t^^c o ^-^rV; ? f 
l;ori^ :;!r.i.? r ""^ parameters o1 ihe current tir^s ga« and tt,e periodic ga« ..cc^.^! 

p^r.r...^;;;!".^- ,;;<i':'..':.:'r.- ' r; ^^'^^'^'^^^"^ « '''«i«<^^<«y t^^e body of th* periodic sait deter.T,ine=« t,c.-r, the 

t<ineOv.s" •v:i'iu-, V ?hf> f ^"'^ =«slar>rarifious value determining means for detarrr n,ng irsian- 



bo<3yandafteorre.c,iJorc. proves. . - ^-^asreiatM.pbeV.ee-^ 0^ o-.r .^gandrh^ 

iu"; . '^'^^'^^'^a ^^^'-^'-^ substantially corvlr,., rotn ^ 

^.-Svi'^lo^ 't- 7- ' " -''"^ *e parameters of the periodic g.i,t ano dr-:c>nCI I 

- v"^^ vr^'^'Hr- '"^-n - si'' f '^'i- "^'^ ' ' '''' ^'^^^^^ '^'^ '"^^^ ^'^^ correcied parameters of she aj -rent r.-r.e c ^.t »h'=> 

noon,^,a^uZc- .;c!.',ro' 'T' '-"^ f ^^^^ '"^"'"^ ^nSfe and waii.,n3 perioa ,nc,ui 

C0024J F«rth£.>. if., sy.!^;^ Z-^'S^- ■ ^ 1 " '"'^ ^ "'^'""''^^'^ equ.!ib',ur^, co.ctil.or 

pan are contiriL.^.i i^^e Soun^. r^'o. - r ccn." > , ' r I''. ''7" ^ " ^' ^"'^^^^ 

•m me margtn of stabiiiSy. car prpdtci tutssfP 'if^h'ilr^rT.i th^ ^Vu^* - -tuaing Jio^oto, can gsrisraU- 3 gai! ihs! is high 
as postur. dive.g.nc. Lru / J™/^ ^^^^ 1 ^""^'''^ " (SB^dva.tages such 
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!. 1 , i . 1 I iioor react Jn OVt. cji or tms pat dnwt ratox <;c ^ V l i f t nq 

\ ^ , P4 t-.t^ ot ac^frofiame sat nc J<3a g al feS'S-S ptui-fr^-! ^ t 't 

i'^^I \s (I icuofyvin^f! y^otion force n.*ji.i>oofceU Mi iff sf«t^om«Pc! p« -f^ 

iro-iy o tho ponodsr «s .ipproxni^ t J by ihc w r -i-fdc, m (J0( o » v ^ ^ ^ . ■> n u -.ra-n oompo 
fttogartpadnc'efcorfctfngne.inb*'' or<,if.^ - ^^^^^ n c'^rt .'^-'^f'i-jwi'buas 

.e. .oc io:.r»^on.s«ib^'.^^.'S*^^^a ^ ^ ^^^^^^^ ^ _ ^ ^ ^^^^^ „nq antaneous 

. . . « - . f tnii £.(^ Iha I in-.t O'M S inserted bciwocR t»^8 currsnt tftrt^ gnit and fie 

10027) Asd8ft'>etitrciaEm^ ,i ts cont qmed that tHe I « ti i^q-i^ - . .oS t^- Jvu cr -or- - r* f>* 
totho advantages and off.U -.le-nc-d «"»^^«'*>^^;;^ ; ""^ ^ \ ^^^"^^^ ^ , ^^^^ 

„ ij,...,y P ■■ '■■'> • ' - • , ^ w;,. (^,.>5w:tP<j rvf-jv'ijy tndiiced byamolforsof the)es}, Without 

c\; s.Dor^rc.aomot«n invert^ pendu^^^ 

aicuat cteg esc on o..6 and. destrec ftoor^eacl on force inverted pend^i^nj ^ X n 

:..,nvenLpe'nd«,u. McJy po« cateuiatrng me«ns tor cafc.ia . . . > " l' n^a ; l";^^^^^^^^^^^^^ 
^alcuiated dspfacere of ttie wetted pcrdtifum ."nd gart gero T - ? c ^ ng a 5-^. 

m"^ w-ri^-'i - erci-'^ffr qewmte i --^f^i based oft the catcutaSed posttton of the bo<(y, ui« toy^.lfc,.= c.t»A .,.,.->pii.> 
jm c rode ^ naocMs the so^god moD.io robot ^nd can ^p»^ance fto hnoarrty o the rod 

,V , ^ draV . ^^ f t «o<5 'ho . i PS8U.0 value of a resattam force r Jrt a *0'^e ^-d 
« oe^avKst r,i he body {rem <it It^bt Ehe c s cuia»Pd ZM^ rf j ire \ r if t i ^. ^t. u 



b dy 



ca!c tidtmg i^eais %r caLufatsng dispf<j<,<.n f the 
the Rupoorting pomt oi ths? mverteo p<ar)duiom. b(,civ 

based ,atlCJ. h ^ d-i^o^-'m. i ^ e-rref.dv<.^tasesar,d 
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by a iieaom coo^'^ao^lUorr: p.-5rt,,ct obtainadby muisipiying the desired ZMP sy a hrsi coefficient. With this, it bscorr^es 
f!ossit),e so i.r.e.5r-cartb:ri,-ii.oi, o; ^)^.^lavuv of ihe raooi boJy Tiore compietety. anc! hence iS becomes possible 

0 oondu« pr^ocave catcu!at,on ec wnemof t>enav<o. o< nccet cfcveiges on a reaMime basis, thereby enaWtng 

than the gatt) ot; a reaHime basis, n beaorr'^f. oossibfe -o cofnt-ns- f^e ■-^wti-.t- eni " ■ is i i- 

10033] yi. ^tfu^ c Jfo ? h. t = . --,"-e- \.^. j., 

« body a piuraiiiy legs asch cu!!'!;ec:ed [o tnt; Dt;£(y compn.'s^fig a dynsivi.c nri^ie^ilv^.g^^^ 

caicuiating meaas for caicuiatir.g a teg feacjion force th,at is a rosiifSani foice o! ir.o.-'i:^; fcnc-- and g.^vrv i'-^.^.'.-l^ K' - 

motion of the teg, without dsperaing on bshsvior of the body; .mm&d psndoii^rr ,r«c>de'^upt,n,^^-'/,J.^,V-o-i or. 

caiculatfna « for catcu^at^.g a pos.^:«,> of « suppertmg poi.t of an inv«,teti pMun: that'dsscritTea dy.'Mmic 

boh.^vmr of !hcbocfy,frorn.«:oa3flhcr;ai.^i.icd leg reaction forcc^indadcsire^ 

c{.spia«;mcm cateoiating .T^-uns to-- caicu!a;i.ig cffsplsccncnt o! the inv&fled pondufu?^ basod on at teast tho cafcufated 
''Tl" ^' '"**«'-*PP'"^'"SPomj of (he i.vc.rio:Jp:>nd.i.rr, «nd body position catei^iating means fo- c.icutemq^j posiS=on 

.3t..r^ deOrf,..n:ng a tf«)ectcry o.^ ths ieg and a :'.^-^r.vv c^' r-.or .es-.t.-. !o«..-;. :n r.-.^fwnsc. to at i.-.jsi a dwand- 
penodic snii pafsr-ieter supposing n-io;3rs for suppositv^ tf)fi> 5a:rtn--{;;e'r, c-f ft ociod^- q.=iit pu-'w^r--. cMrront 
time gait .n response to at least the aammQ: penodic. g^sit tonndajy diveroi--^' w^ip'^r'^rt <I-o^^-n-'itrVm'^--fflirfor 
determining a periodic gait iJOiiodary dive;gent componenr that is a value ,rdic.^"ng div—Am c— -r<- a'"o^^- 
boursdaty when bet^avior of the body of ths synodic gat ss app!oj<imated by the dyna.r=ic r^oasi basod orMhe-Varam 
eiers of the penodfi gait: cmrm i.ne ga:; c.^Mnewr corr-scthg meatus for correcLng the para.^etere of the current 
t^:l!'t^ f I If ""^f ^on.po...t bor.o-.e.s -oqua) !o or becorr,es sufetamiaiiy «quat to each oter sf.tenT,inai of 

time gait, Wiih th!S. the svfiiisrr; cv> ■■ „..„■,■„,,■■■ ..s.. .... , 

Claims 1 snd 6. ■ ■ ■ " ^ " " " 

E0034J As defined in cia:rri 5. ,s co;^J gu.L^d tt;;it the f.co- ■e-,..;;:<.r: i-nc; r ,.. i^ast ^t f wi'i' <>;i-^ s-di' on 

to the advantagesandeffectsmansoned with reference tociainisi ui>d(^ 'tt^<^conv.=^v-,<iyrod.-&--h«ti,o^'o-' ta" -i^on 
fotca, thereby enabling to have the advantages and effects more t.rfriiy ^ ' ' 

[003SJ As defined in ciaim 10, if is configured thai the inverted pendutufn js a lines? modai With this the systc'n -an 
acnseve the same advantagfes and effects as thosa mentioned with reference to cfaime 1 and s, to pattteuiar in c^aro s. 

SRt^F DESCRiPTlON OF THE DRAWINGS 



"^'^^f ^..^'^^^^ ""'"^''^ ''^^^ o;-',g<..mion of , genorat^ori ..ystt^rr, of s lec,g«d mobile r'obot 
according to an emboafrtierH of the pr&sent (nyenJiori ■ 
RgureS is (jn explanatory .:ct.v..v .hc..in. .tr.=-u.. ^ 

Figure 3 ir> a biock dragram s.h«w,ng doiails of a control un.t moynsd on Vnc robot ilfustrated In Figure V ^ 

t ipure .1 ,s ;i bioc.i< a-.w^mrr, showing the conftsuration of ihs gait aenofatian system of a tegged mobito robo- 

iiiusfra^eci [-.gure J tn a functfonaf manner; 

It""" ^ f J'" '■'^'■^'•''^^'"■■■>' f-^o^ifiS a dynarrtic rrjode! that approximates the iegged motoite robot iifustrated 
p.r.'^T.^ I"!; 'K-"T'*r^ Pfif^ciuf.j:r. -.-J he u.--dl>y f< f^ai) s<^^!.■^'^>tor:!■us!.^iled in tne cnnfinuf^tion Shownby Fisiir64: 
'tiynanr mc^e^'ilh^t'-l^^*" •^'^"^^!*"^' •■"/rirfniic calcii!«Eion conducted by the gaij genarator with the use of the 
-gufc,',3..elc. ^.-^ y.,.'. 'hc/.r, -a.c-y ^ . ac-n P of t.^ ,^,^!i,,ru fo^c^. of the inMiaifo^ce 
.net gra«ty cf the teg.. ,-v,.:cri.i pc.i to be .....iniir, .....oo ZWiP vaiu. ZW-per,d indicative of the 

suppor-tng polfi- of the invefi«.-;i panoijioiP of fhe (Hy-.^r- c rr,-cis !!i;.-.5;'att"d !fi r-rwe 5- 
Figure 8 IS an expianasosy view sho-^.ng a SFtuation wbers a tfajmoiy of tfie body of the .robot ilitjstraied in Rgure 



Figure 9 is a set of ti.^n^ ch;;rts ,.iv)^vw,g the psoudo 2MP vafue ZMPpend, in diseretixad form, indicative of the 

supportinQ posm of the invefiod per.mum of the dynamic modei illustrated in Figure 5- 

F=gtjre 1 0 a !irr>e chad sinHtariy shewing a trajectory of tiie psaudo ZMP value ZMPpend, in waveform, indicative 

ot -he Sv:ppod)ng point oi the inverted pendutu-Ti of the dynamic mode! iiiustrated in Figure 5; 

f igure 11 ib a sat of time charts showing resotved parts of the waveform of the pseudo ZIW» vaiue ZMPoend 

itiustratec Irs Figu!® 10: 

Figijre 1.? is 3 ttow chart showing tho oporation ot El^e gait generaiiof^ systetri of a legged moMe robot (ilusfrated 
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in Figure 1; .^^ ptocessincj c>! sne flow ch^iri o! 

T ! he wic=if.iiion !>f inttia! divercjem componsf it oi the steady lutnsfig 

miw char' OS FiciU!« 12; . ■ ,.rt,- ,-^,-'i-d 

a stxpMnp covfecticn oU desired ZMP o^■;u•:vc"'■ S-"-'- P« " ■■^'^ ^ ■ 

Fouc LlrbTtin. J h«r.s ow^r ,h.c«icuiaf ion of insta«U6 valuer of tho current time gas rd«rr^^ 

^^^"^ ^ n Li r^o,v-i--, ■--■S by tswgisit generation systsfT,^ 

^•"^ Fi-j:fi 15 bu; showing she cstcuiation of the ioifiaS divsrgertt ccm- 

^ J ^ y »c -ation ot a 8i»(« generation system of a iegged rrobiie robai Hcccrd:ns 

' , ^ T!o?m^ 17. bul showing Ihc corrector oi ih. do.iiod Z^/^P oi ih. 

cu t it Urete nxr op« of 1h. gait ge.«ration .ysl.iv, of . Ses^cd nr,obi.o robot accordmq to 

ayitmrof a teqged mobite robot according to a third etnisoditrer^l of mo pvetmx "^vention^an« 

STsS fe Jexpianat^^ry view showing a bipscj moot of a legged mobile robot modeled w.th a« hnte set 

maieftai points. 

DETAiLEO DESCRIPTION OF THE PREFERRED EM80DIMENTS 

t00371 1 r« oaii qensrstion system of a i.^ged rr,DbSe rot>ct «=-xordmg to the present i«ven«on wiiS be expWned with 
!°! ic ^ ^M'S;STOiod drawings. A biped robot is taken as an w!e of the ieggsd mobiis robot. 
;S2] \^Ir^TasSem«tbviewshowi.98nov^ 



.!iustfii!(or. !S oiTiittfd. ^ aiv-n -X ci-^aro^s ot Jreodoai When the 6 * 2 - 12 joints are 

a;bii::;=;'i;; ^^^.g Ini.o.r./nt o. m^o^^^o^^ i^^o.-^ space en the spe:c.n.ation . ' repres..ts 
ji... .-ai-iiffltion csncf ouier prciduct in vector c:aioulation.). 

SSrt2;,?i;;i-t:;t:p;.ition 

of <. orc^ciosef.'nsned position of the body 2^. speoficaity a representai^vc po.ni oJ the b.c, ...4. ^ ^ 

100441 AS f-hown in F.9^^« ^ ■ » f^^^'^'" ^""^^^'^ p'®^*^'''' ''"^''^ "Tf T'^l-i :! '„^:;,„~.;' / 

54 is disposed at a position below e«,ch ..nfcio joint for Se^^^'r«;ir.ci . -^.-^ 

Tsina^ indicative of foot iandmq and the tsoo; <.^.ct,on force {the toad .:«;t.n!3 irom J'^s f,oo., ^ orsuv. , 
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^'^^^at^ C^w cirfecEicn c^f ^jr^^viiyj) ..jr,o ,13 sriguJa; vsJocity Vhe eiectnc moiofs of the respective jo 



.■^>y oficoaoiT. w!i:ch gsMeraSf: ^.g-.-^i* :^ngi;;3r dispiaceoieftts 0? *8 aisctfic motors. 



J position upwarci from fte foot ??R(L), which 



ETvetnbef {nol shows}) connected !o -^ije q' •■■■e h'-k'-:: jc •;: ^SR'"! i'^'CRr hL. ihe-'n^-I 
i: g-ji'Je rrifimber with a 



i? -c :r.s--^>?<ir 40 siisched io ihc solo oi the foot g£R 
foot ^.?Riij, «nci a pts5ort 
ssfisor 34 and irissnsiJ if! 



[0046] in th.^ fi^uf e, She teoi £2R(L) tiiijsbated in {iiici< iines show* a ojntJiiio.-, wher-j n t^oo- io.i fo--o i'< ir^o- r^-d 
Wh?n suDjef-ec! to !he fioor ffiaciion force, the spring machanlsm 32 and the c-cie =-;!astsc rnsmb^sr 34 wfuch c^n^i.-^^te 
i^^s- :-;o^r>rji::^r,;-'- ,r.ecr:f.m^ 42, cietofm such thai ihe foot 2£R?l) shifts to the position ansj pjjstiire -iitisiraied >'-^<ia'<-r-s6 
. :no^^ T h i :5 oor f >cR» :it!Of. is significani no; c:.(y tor tJowossing tte foot-faoding impact, but also tor enhancing :hc comro'i 
''i[:':'";':,.^!':f ^^"^ cvnf.j;.;j=,-ji,on is disclosoG In .sn appiicsjlioo IJapancso Uid-Opcn Patent Appitcation Mo Hoi 
nn^,.;; ■ 3i.K,kB-,, ptcpoaed by tsw uppjicar^i, lu!th«r expfenation wiif ba wa^i©. 
[0047] .Ai;ho.^ah n.:^. showf. .n Fi.;<jrs i . s. joysiic^ ,s p,ovidect aj an appropri«,o tccat.-on of rhf; ftipf:.d .obo! 1 , which 

00481 ".guw . =s mocjc c.-^t«r, wn.ch sno«s the. de!a;s cA the oontrnf „nrt ?6 comprised mifwcompute^ Output, 
fron> the tndnatioii seinscr 3S. elc . sre cowertsjd ifrto digits! signftjs by an AJD oonv^rte- '^■t ^r,.-^ ^5.^ then -r-nsrrii-ed 
through a bus 62 to a RAM 64 Outpul signais from the roiary sncod^rs. ;h^it sre disposed s-di^c-r^t t>^s resDS-iiv- 
elsctrtc motors are trar>smftted through scounisf 56 to She RAM 54 ' ' - 

t0049j The coniro! unit 26 includes a first arithmetic unit 60 and a second arithmeitc una 62 rasc.-^ctiv- of which 
corr.pr,ses a CPU As vvif: be sxpfain^ci l.ier ihe tirj^t arithmetic ur^it 60 cor,tSticts the gait generation, calcoiates joint 
«. .s-e ciisp:ac6rpent cotTinijincis, and r>:.jtpu!s she same to the RAM 54, Ths second arithrrietic unit 62 reads the com- 
mar.ds and the cstoc^eci v:i:u«s froir, sh-s RAM 54 snd ca-Guiates values {manipufeted variabtes). and outputs the same 



Shrough B D-A corive-'-sr 66 arid s. 



which drivEi ths rgspeotive joints 



Sr.'?"" ? ' — ■Jur^.o. .r,d ...oo..:on of th. g.ii g.n.r.tion system Of 
legged mob;ia s'oboi accordmcj to tht? s^i^-.mdur'.vr.i 

[0051 J Expl^aining th^s, the system mctt.o<.s asai! gene^.^itor loO which generates a d«si!«d gait freeiy and on s reaf- 
tsme tosfs and outputs therr, as w<!i be expiaif^ed tater The desired gait comphees a desirsd body position arid posture 
^|ajeetofy): a desinsQ foot posiiioft and posture (ttaisctoiv). a desired tota! floor reaction force centfBl point /desired 
^NV} (trajectory) and s desired totaf fioor reaction force (trajectory or patiem). 

pOS2J the fioor . Urn o^af foot SZi^^v, ,s called a foot floor teactrori force" wh.ts' the rosu tar> 

f rro he !oo' 'tc ' r ^c> r ( c . t ^ o ■ both test !s Cdi ed a total floor reacjon ioice Smce .he fo-^ t-or 
raacrohfcce<ftil ^ Ivd=-^ ttr sur h?f Jiovstnct S^e-^lcso react on force" wtf be vJS&d<js, tie -total tioo'r«>«t or 

force it i! iS not speciDCfi-iy riescrihod 

t0053J }l f ! 1-^ } i oL<, a K * t = r, i n 

; ; K . ' ' ' ^ for . d .1 ,t -^^r ^v.nfOrai-TOtoqoreraea 

* -cfYwh-r-.- -s af\*c od ^ !„ rQt^^ <.r^T,•^ 

ance con* 0 procc i &v he af.^.i • f t > ^ 
[0054] t' the to- us?- ^r-ft prp.s , , t^, 
"tn. Qo Qt n , <,.^ vlf^ d-c nf<3 n t,i,cr, rts^os - f > c n,./( i, to dec c f^o --r'. tWfC-^y 
r 10 ;a t M it !i > V'no 1 he robot «i aooo. to turn ovo Jie dss, ets ftoof rsacton force is mtentioiaHy «raftcd 
''^ '^^ f'-J"' ' <itt!. iion force, ther^y restormg the robot posture stability 

^'^^^ ^ " hu«i ft!<ttmp-^ (>^jMo<M so stable waffti riocrmf>»fon one s *i-e re'^ lonship 

^c^-^^r^^-i { t , •< cii)-r< - -<i! 0 , ',rT> ^f ihrd>rc-T,cpoiJ!l>>um 

, _^ ^ ^ ^ ^ i h h r r^l n t e dssred 

^ ne'- uf ^ 0 " a ! -n, acito'( fores 

0 I.U.I- ^mt /«so 1 lu.M ! ih^y - s , ) < h.r vhc- "c^ , , . on . ^ 

force and W!ii. at worse, turn over ^ 

fOOSSJ t^,, e-. i^.q i fo^^s^ ta I u the .s cts, Loratt y . M in rc fore - bil.ty wrs't th-> i^ ^bc t - 
1 vs"- ( ncf< rvoo- ( r- c - "^v. 'f e e qed nobiia roLo. <st x, d ^ave as desired vaftios sr- the cot^tre, 0* 
" '^'> fa-^'■^T<^ t-^ 'm but a! 0 the de<5trod'foorfeachon force patft.fr la<it sat sffAs 'he 

uy.u.T,,,. ,..,„„„vi>uf,. ..,«iu,t,vr! ,jya:n;:! fne oessrod sT-otiof) patterfv 



[0058] 



r^vcf^ tb' -o- f ^tur ,n ib¥« ofi,edrdmomcf5 ^-^^g 
< has uMsfotJs ooscnmons 
"* " - ^ )d r-'dfi'^oro-iction fDrcp>cfe^t'■a 
j:&!o Qxc^t tof its ventcst coiTEpof^ens 

eo., f f> ^un ct Id i>ijr iifce titj Z V» c ICvtaied frcT me 
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dssiferf rrioi.on traieciofv and the des«c«J Moor r«5ctio« force cenKal po.m are equal » eacn otr^cr .he cesirea 

[0059} Tr.,.otw.= sno c.ao t><; r.c. ... ^ejoc'. ..c.!.;i«> rebel nave, as ae..-^:i .hU,^5. -n f„« 

control of iocomoucn. rsot os^ty she tiesircti moiicn psttevn ar -.sajec^sory. but tht; ctesireri zr.^P vaj^wry (doa.md 
fioor reaction force pauern)"' 

£0060} Based on the above> She desiteti gail is defined in Shis spcdf icalioft as foslows: 

a) The desired gat is Jn a broa<J sense, a set ef the desired motion trajectories and the desired Isoor reacliot; fofcs 
pattern over a period of a waikSrig step or sveps- 

b) The desired gait is., in a narrow sense, a set of the Jtesiract motion tfa|«sctorfes andthe ZMi' trajecSorv tor a perod 
of a single waitiing step. 

c) A series of waticing is comprised of a series of gaits . 

{QOeil Herein«fter.foramo«rapiduncte«iario1n9.thede*iredga.tisuserjterepresentlbalgj^ 
sense unless ft is mentioned to me contrary Sp«cifica»y the desired §«« is used to mew a gertfor * penod begnnms 
from the initiat state of « two-ieg supportirig Period to the tenninat stale of a or«,.ieg suppo^&ns period s«eceedmg 
the-eto Here needtess So say. the two :eg stjsporting period rrieans a period ciUfittg which ihe robot 1 supports its 
weinh' wnh *wo iegs 2, whereas the on& Seg supporting period means a penod during which the robot supports sis 
weiqht with of^e of the two legs 2, The leg {leg iir^ft) 2 which does not support the robot weight duftng the cae-leg 
sup^ortlr^g period is calied the free ieg. Since the definitions are deschbed ir> detail in the proposed appS.cai!on (He. 
1Ct{1998}-86081>. no ttirther exptanation wiis be m.^de, 

fOOSai The object of the present ir^vent.on is to gener.«e the ciesirt^d gait defined above Jreeiy ar,d on a reai-tsms 
basis tf such a gait can be generated freeiy and or> a rsal time sasis. it becosr.es possibie. ior sxampie, ior art operator 
to n^anipulate the robot 1 by remote control Uore^ve. in :r,an,puiatmg me rcbo, 8atomati:c..ily, ii becomes pass.D e 
not only to oonmi tne robot to walic in accordance s p.ede=-rmined sequence, but also to gy.de ttte robot to walk 
along a path or to effect high precision positioning. 

[(mm Here, conditions which the desired gait m^isx satisfy wiii be exptamed. 

[00641 The conditions which the desired gait n-iust satisSy wiiS generaity !>e classified into the foiiowng five: 

Condition D The desired gait must satisfy the dyt^amte equsiibrjum condition, in other words, the ZU9 trajectory 
caicuiated dynamcaiiy trom the desired motion trajectories o! the roboM shouSd accortJ with the destted mP 

SSS' 2} When a demattd(s) or^ stride or in the sng:e of mn^, etc.. is made by a iocomotior^ ptanner orpath 
DSanner (neither shown) of the robot 1 or by an opemtor, the desired gait must satisfy the demandts}. 
Condition 3^. Ti.e desired gait must satisfy constraint condition in tcinemaiics sooh as that m» fobol foot must rtot 
dig or scrape iiie floor on which it walks, tho joint angle must be withir* a movabie range, and the jomt angufar 
vateeity must not exceed a pern^issibie 'ange ^ 
Condition 4\ The desired gait must «iso satisiv conditions of constraint in tiytjamfcs asich as the ZMP having to 
remain within the foot sole fiocr-cantact area during *e one ieg suppoftittg pefied, and trtat the joint torque must 
not exceed a possible maKimom power otiho joint actuators. . , ■ 

Condition 5> Ti^e dosired gait rritJSt satisfy boundary condition- As a matter of course, oondrtron .) raauits m th« 
boundary condition that ihe position and veJoelty of robot's each part such as the body must be corttinuous m tho 
Qait boundary, {if not, infinite fofoe wouid occur or the ZMP would move far away from the foot sole ftoor-contacl 
area). 

mossi More specifically, the initial state of n+1 -th gait shouid conrsspond to the '.errTV.nai state of n-th gait, especially 
in the body po«aioP posture and vetoctty relative to the foot posttioa if the initiai state of n+l-th gait fs aiready deter- 

■ pine'^ it suffi'-es 'he Eernina! state of n !h gait is accorded with the n*1 -th gait initial state Jf rvot determtned, it suffices 
the^erminaUtate of n 4h gait is within a range th.=Jt ensures continuous wail(ing without ioang posture stability. How- 

J even as wiii be discussed iatsf. it is quite diffteutt to determltte ihs termiriai state range whicii ensures continuous 
walkir^a withoiit losing posture stability. _^ , _ 

r00661 Gsneraliy spoakinq. the desired gait is gerterated by a gall generation atgorithffi indudtng parameter vaiue, 
or timtseries f.*le data. (In other words, to detet^r,ine a gait rr^eans to determine the pararrteter values or tfrt,e-senes 
tsbia data appropriateiy-) j ,. 

5 100671 Various mks of qaSs can be generated by changit^g the parameter vraiues ortime-series tabie data. However, 
K the pardn^eters or 5i.r,e-series labto data .«re c!stm.T,ineti without paying careful attontiort. it is uncertam whether the 
generated gait can sa&fv ail of the conditions mentioned above, . , 

[00681 ifs partscajiar. when generatirtg the body trajijctoty satistyirrg condition 1) based on the 2UP trajaciofy by a 
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■^tinuoi;s walking, of the body position and veiocity at the 



ga« gensfation atgomhm. even tf me rangag suitable for c 

aont ' [ _ :t^,. i^unn. o t* ^pa-^^etefsreUing to the 2MP trajectory' s^^^^ 

(JOiiciun .-s;-n; vf.>iOi,:i!:y wti -.ati mv^a. ihe langn m ifis; wit end. 
(0069] The I Bi:soi is, ihc cslftKui-y ate iis to^ow j ' 

mftMi <■» '■ '-""''"W»'"''-'<--^r<- - irv. t...mais5 the behavior Of msrotsoibadv 

de.:3r,or, aivc>,gi;s i>,o '^er.am^y, tufns over. Even at the time of turnover, the ,«si;:;^,n! fare, of t^e mti'- for^<^ 
giavily of ir-:s .-,vv-aeci ps?nd;;lur(! is acting on the supporting point {in other wo,xi&. ;hc ?ViP k?pt -a^mi so i'^e 
..JBpar.^ic) pent), ^na ^.ne rfis.:its,.t fore© is. kept baianced witb the fSoor reaction fotce acting m,oygh tf.e support-nt: 

■'td Uv'.^n"h' ^^^'^'y relationship, at ^nstanoo, botwc^n the inortiai force 

.;nc! gr(tv>ty and ihc rsoot fcacjuofj force o? a snoving object 

H '^^sconceplion that co.tim;ous robot waiking is ensured if tho dynamic eauitibriu^r, sondiEion 

s »..t,si.«d. Hcwc.ver. sat>sfact<«n of the dyf»a.^ic equilibrium concjition do«s not mean the robot is at « stable p Jt«rT 

ont rol^llrlt'J r^"'' ' '^'^"^ "^'^ enter 

r«Sy iSriom ™ ^'^''^ irrimeMy above the ZMP, to move farit^er 

p073I Reason 2) The ons-ieg supporting period requires that the IMP :r„..„ c,; wsh:-: ^uppo^^nc .-^ fov «^t- 
f:r,or.co.t.ci area. .tc. D.e to rigid condftions of constmit^t s.ch as rh ^ t ,,0 nfc oody accdL^J' 



e gait gens 



fOQ75J Cantinufrigtheexpisri...,.., .j,,; ■ .iu«r>-.r->.. .••vw»"^r'^ ' > 

fTiotion parameters and ths zwr^ oa; or .'mor-^ r:>n,r.,CMy^^';o-' T^^j'^e ."^''i" ^I 'V'^T ''^t'"' 'i^'^'^f 
Drnmstor- is tjssd m this spec.f.c.!,cn to ...an a p;f«metc.r relating toL'flcm ;;aci,o; 

?rifL?^ ^'^^ f " ^^^'^"^ ^ ftroten-fine pattern as wit! bg explained wfth raterence to r.o.ro 1? 
./e^rreci to only m .he X-coordtnate in tfts figure) at^O fe describee* or expressed w.th r^^ecl to the coord rts- o^ X Y 
and Z {directions) by tf^s po&ttiot^s of the braking points and passing times of the pattern 
S S ,'1:'^ LT"'"'"''" ""'"^'"^ ^'•^^^^^•^^J para^fetetB and the fcod-y mje&ofy) parameters. 
Kl IcH^n ^ '■ ^^"-^^""^^^--^ '^9 g) position and posture, tem^inai tree isg {foot 

accordance with the techniques prooJd .4: w b^^c-^o i^-' 1'?"/^'' "^'^ 

S *Tf ;f ' '''''' ^^-or^^p^^-^^ i;^.n;in;;i;;;ion 0; dirS^nJSr' ' 

. it? r P^^^^^-^ determining ths body height {value in the 2-direc,ion), parametet^ detorminfr^g 

m'.ai body possson (dispiaeemenl) arjci velocity, etc, 

[0080] Based on the pBr«me)ors detefmir^ing the body positiort ar,d posture. instar»taneous vsiues of {he horizontai 
oody posmor yb! and posture {Oxb. eyb, S?b} of the body ars dsterrt^inedin accordance with time functions or the 
u-.v.:i|^.q.je proposes. e.=.r!ie,- by the applicant in Jspm&ss Laid-Oper, Patent Appficaiion Hei 5 n9«31 •■ 024115 The 
AppBcm-on Ne He. 10 (!&98; SfiOSO r;:..S.-.=1^.; t^"!!!"^^^ '"'P'"'**'* :..;^.c!.opfin patent 

calcuiatsd ay «n ^nvers. k.)err,aiic soi^aio. troa-^ me ootainc-a f.ei pr:...t,or. .nd pc,s..r« .nd t4 hodv';': 'o^^^^^^^^^^^ 
posture, as w.ii be axpteinsd later S/lore speotically.. ir^e desired robot t..ostm« .at cu .-erE ^i-ru'' -Jois^V defeT^'ir-i" 
^^'"^ ^'"''^ *^ S^nenatioh of ..n .do«i desirod gait car not ;ic! f^qalnst physicd a de- 

rnandcc t«ais can not be reached immedistoiy. The transition to the demsnded slate stioutd be achiPv^d .^^viy 
... -ri.x^ig ci.^it P8? ;:?r,£T:ers such 3s the ZMP trajectory, landing position anri (anding time. etc.. within oe,-rn;.^^Mblp t-na-s 
PI P«t-..!Cj;ar. ass^in^mq the dynarnic system of the aiped robot In this embodiment as a system thai - 



^3uL& body position, if is a *vetgence system Unless the gait pa.wnetsrchangeiscVhduoted car 



difticuit 

[0083} Theretors. when gs.nefatsrtg a ^sil as 
behavior and to determfne the gait parsfrieters; s 

aleps from rmt does not diverge, and to correct the gait so asto avoiddiV9rqenc^>^8p^fe5"ofa 

divergersce is p.^edisted. ' 
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ro0841 Ho-^cv-r discussed abovs. ihe mi!itipie-rrMic:--i'-Dc.i=>t rf,oa.-5i ss ahown '^n Figijre 23 =5 used, since 
S voi-rn- c/ o^ioal.tio. tarcje a»d the system is nol !«r,...- ; . - : r- .^ ^' c.l^ ior « .su,.f on-board CPU fmounled 
on -.ha rooor, . ^: is^^.- arithmetic ^nit 80) to detetm.^. : >r, * =c-;.i--.nno r>asis And as mga.ds 

re'^^t"£.= ^^ei^^v.r^. , .retJ^ction and divanjencc pfEver^i:or> lecnrifque bas<^« Mor. rn'gW be .eafeeti to a certain Isvet, 
t V (o- ^>!' «'o'nn'' v^n--.: ^■if>c!-^ 0^ kriowtecfge and oy seiecting a dcsisBd QSiiJ ai every gali $wltching if-, respoi^se 
^nas- ^r,"ci"ob Bci.ve M^-A tiir.s t;of^ i^^e siorya kiwv^fedse, l« pmcltce, however, a im\ io cope with aii posalbte 
'-ondd'on would c«u!>e an (>xp!Ci.on o! co!!<t.BK,iior<, <jnd !h:s rrteihuci would aoli;<i!iy be srrpossibte ^ ^ 

[0085} !n View o1 ihc above. K is configured such iftat a dynamic t^iodei ftta; desc-ibes the dyna-Ti^c »ciua'.oi c: i. 
robot 1 is simplified in such a way that ?uttire «jboi beftavior can ar^atytfcaiiy ba pr.^aicAts:^ ;r: c.i^CLifftticn or c; r«:.-;!-..!'it; 
bas% PiQure S shews ihe simpfified robot <Jynamtc modei. As fikjstrated, this dyoan^c rnocia; trre->n^s>iei ;arpo^rt 
rr^om and is docoupiod, i.e.. tb« dynamics of the leg and thoso of the body do not intDrfcro vvjii^ c&cn other '.nc 5he 
dynamtes of the robot as a whoic are oxpressetl by their tinear combination- Figure 6 is a biook diagram showing 
dynamic cateuiation (conducted at a dynamic calculator in tha gait generator 100) using tho <lynamic mocei =)tustra=ecj 
in Figure. &. 

[OOaS] Ti-i* ■■lyr'.imtc rrso-js.-l wii; be cxpi.iirod 

1) rr^ofi^5! compsi^fls jiitefi nave-iai f)0>nts >T5ade up o? an inverted pendulum, a loot msteriat posnt of the 
suppoftirsg tea and a foot mattsriai point of tfse free isg. 

2) T-ne sucjporting Sap !oot f^iaSerial poin! is set at a fixed point on a coordinate syslen-. set locally at tno tuppc-ttms 
isc'foot The coofdinate sysien^ is a XYZ rectangumr coordinate system in which the ongin ,s doi^^^ed on a so,s o. 
the foot projected !rom Tho confer of arkie omo -he: sose c? the foot, the X-Y plane is equal to the soie and She X- 
axis is defined as the direcsior, uo^. iU^ ne^ ic \ort Tn,s coordtnato system is hsteiftafter referreci te as supporting 
leg ioca! coordinate &ymrx^\ A coorcim^t^^ sysicr or .^o J.xcd pain! on the supporting feg iocal coordinate system 
is hereinafter referfsd to as "sup»criirG!ogfe:>;'^\H:s' -^:po:r; sci;set ', 

Siniiarl^. tre« !S9 foot matar.ai cc.nt . ro^m cocciinste sysSert. that ,s set at the free ieg 

fo.t Tni. coordinate systm is hero,r,..«- ro-..oa c .... io...i coor-.^alc s^^.ten^' A coord.nate sysj^n 

on the fixed po.nt on the fre& ifeg iocs! coordinate system is hsre.nafter rstatTad to as ^ree leg foot 'iiatena, p^-int s 

A en--., cjin -«c- v/^isfr, whoss ongin ts definetj on « ?oot point projected from the cemer of antsie onto the f iocir 
whan tht suopr-ung leg foot is entirety in contact with the fioor, and whose coofdinstc axes are fixed on the tioor 
in s^ct^ manner that the X-axis is defined m ihe front direction of the supporting leg toot, the V-axis is deUned m 
the sett direction and the Z-axis is defined in the vctttcal direction, ie hereinafter referred to as "supporting lag 
coordinate system" m ts different froff> the above-mentioned supporting ieg local coordinate system. Unless tt 
is rner^tioned lo tbfe conir«^. the positiof^ ths velocity the force, etc.. are expressedby the s-jpportlng tsg coordinate 

3rrhr,nvert<.ci o^-. r^p. .-30., a suppo.i.,g po.r-,; . that t, soiy n.c.v^bi« ,r. ti.e hori^ont^t d:roction . a material 

DO-nt D arc ? i^r^i-- c that connects !hs supporiit^q sjcint and the maierial poirti, The i.nk is expanstoie anc has no 
■n-'- - "i- 1^ -.-.'.i.^-pd he;e She,; tho ii;ii<. expar.ds. when liiting, such that the heiSh- of the rtiass viewed from the 
Jppo.vr,9 isc-'it !s kapt constant. Th« ,nvt>r;ed pendsiiifm is the same as a linear inverted pendulum of a robot 
di«Cit>ssfi ir the? atercsaici oubiicalsor, (Hoi 4 (1992)-1 &06S). 

-he ma er a poi«* c* ti^e averted p&Mm cor r t - itu m o o 1 cly ^^r tho fee-^se o 
physfcs {the body sm-steriai point does not always q <^ y ^ r i qtv ^ rr^terai oou t 
hf> nv>«led pf nduiun ib tho s =>me t^>e maiw ^ s ^ ^'^^^-f / -le ct spt.*ce 

,r:5?it, .h£ ('■■^ f^r^o itfj <5 rft<^ 1 f>v„ i,^,,.-,,-l..>ri..,,lrril>k<'T^''^ ^>wi;'nn?aiomitiC>n, 

^ ""he 1 I r o« ici f r 
p..f..i> ! l^i^n . K - V >^ a h SUP <^rt 

c ^c^^i att <^v- 0 tt^p <^ 5 e uitn ivd loint ^i! ff^maVr cio td to as tody fepr*> i u joint s or a co 
.-. jg ..-c-'S- thf >i-^dy {the coordinate is haretnaftet referred to as "body ooordtnate system ) 

ir^mnen pt^ndutum's horteontai position. More specificatiy, the body-reprcsentrng point and 
th . 1 ,ap noiiiun-in «5!onal-ont bars detenMtied such thalthoy (oonnesamever'cai ne as iiw«*raed 
n c q re ^ A hor^onta -oordtnals ■>« fhe faotly represontjnq point on ih \ uJy -o-^r i n ito systen ts refer ec t j 
as "body matertat potnrs offset". 
[008^3 c f t ■) 1 of s ir abl«s and para-nettrs retatntj tc ihe tltoslr^tcd dyn i->nc eolation -nodv, wt the be 

[0086J <"ot t xp^ta^ot (.sf Ahio^.^'ivifaia-ietersfoiai-ixj o!ie-tyi8mf,culait^tionmode!arodeftne'>and 
PSSrVeai-^'oHXlfVtirtCClCCft^UUfi^f •! b^f, <. or^Mth^-. f parting p. « r^-e the ZW « ds>f nPd 5 a 



to 
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•n^ru .s generated «nd the supportisig point is free and hones mo mDmefi> r gene'-atfct the-e 
,~H)vn V L iS; .i-!dfviau«; fsiKie-w; poicits are descnbecias foSiows- 



n.o. averted pendufurvs fnatew.i poiRi fiisss (body's maicriei poim mass) 

mtotai: robot mass ( ~ mb 4 fnsisp mswg) 

mfe«J: {©ei mass { ^ msap + mswg) 

xsap: suppoftifig leg's materia! point position 

jcswg: frco iog's matetiai point posftfon 

xb; inverted pendulum's posStior> (body's materia! point position) 

p091l Or and an*r. xb is expressed fay three-dimensionaS vector (XY2 coprcJinate system vector), ff not mentto(.0d 

I f ''.''"''^■2' I f ^ * ^""^^ '^-^ suppcrtiRg point the materia! poini 
ana is oescriijeo as n, 

f00921 P(xb)/cfi is the first order diffsremiat of xb and ir^dicates the vefocity of the inverted pendu iurr* whereas d^ixb « 
hUS !S ths second Drctef diffsrcntiai of xb aod indicates the acceieration of the inverted pendulum The vaiue o 1 s 
constant of the accsisration of graviiy. G is a vector of tfte acceleration of gravity and is defined as a vector whose X 
Y componenis aro a and 2 componsnt is - g. 

{0093] In She fflustratedthrefi-matenal-poimrwdsi. memom of totatiticrliaiforceof ti^e )eg materia! point actingabout 
a po.nt of action P «s defmed as "teg's total inartiat forc^ r^on^m about point P". Here, the resutot iom of theLrtiai 
dScrib'SSx?' f^sreinaf-er referred to "tota! inmiai force", Th6 coor<3inate (or position} of the point of action P is 

momtm SoJt'p'^'''*''"^'^ ^ ^" ''^ ^^S's totai tnsrtiai force 

iog's totaf iFjeriiaf fonc© nioment about P «msup{!«sup - xp) * G 

- fr!swg(.xsw§ - xp> * d2{xswgydt2 g^j ■) 

?f^?..!t>tt i^^'f^'g^VP.sapse.coyaiuetobecorrespLlng 
i'Xj . -o at no- d '0 < - ^ono'i' f<boi-! P iifcet > {ZMPfoet - xp) * O Eq.2 

SSsJ'"^?!'"'!, r^"' '''' ' .r, r ^9^,^ 1 isnon-unoar Therefo^s. by approximation, the 

zSSfpSr ' ' ''"''^ ^"'""'^ ^"^^ ^''^ P«ndui,;mi 

2MPpend==mto!ai/mb * desired ZiySP > rnfeat/mb * ZMPJeet gq 3 

[0097] Generally, the differential eq.afen describing the b^haviorof & linear inverted penduJum -s expressed &y Eq, 4. 
dKixb)f'clt2's horixontai coiriponent 
» * (xb's hoflxonta! compcrtem - ZMPpend'e hofi?orttai component) Cq, 4 



(0098) Here, tsie pomt of mien P is se! to irt^proye !hc ^ocumcy of modot gpproxinjaticn For exampie as .'>u-.tr«ted 
.n « t«ne ch«.t «f Figure 7. ,h« poi. ^ «.tion P « .0. in a m«nr«,r m«Tmo»83. at 8te s ji dyr^glS 
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two-ies supportirsg period, from the origin of !ne siJPt^-;'^i"^7 'S'-; cc-otci'naie; sys ;(?it. of qa ) irTi-nsdfaieiy bcf<;.re {iEisi time 
gait) to thai of the ciifseintiis-ne gait. ,u k ^ 

t0099J The c!ynf,iT>.c mam prooosoc! in !ht= ■■ -----^ ='-:^ ^ ^ ^ ~' ^^i''- "■'O'^"® -^ccorciirig lo '.tB ombc".- 
i.^e'it ^5 i?>tp(a?SGC t'V t!^^^ cHsfits descr,-.>:rK3 rvr-v ;-.£-.A.iO' t^o '00: iH- DQCty and -ne n-.Atsna! psmfs i-as- 

:-a"^<^ ifi FfcjL'p 5 i-nd 'Me cq ifiSion," if "J ^ ; ■ ^'^ : ;.!v',yi:rc«-'jn -riiiKes.- !i c^^sv predict future bshavfor, ss will 
be explained . , 
rOIOOl Expiy.ni.Kj liit- ope.alion s-.e dyn^-sc :;..!.:;u)a!o( «f Sht- gait senejKlo. 500 (:itusfr«t«ci m F.gure 1 , w-m rof- 
erence to Figure 6. it i^as a leg ZMP calciilator 200. The cafcutaior 200 calcuiates ttie teg 2S^P iZ-MPie^t) b^ssd on 
rqs 1 and 2 afirf on the point of action P mustrated til Ftgure 7. 

r0101] Then it cateoiates the inverted pendukim'a ZMP {Zfv^Ppend) by frsisitipiytng the caicijlated ZM^-.fi-.Ji ay mieav 
•ntotai ijy subtracftng tnc prcduc t fto'>^ 'h.- dootrcd ZMP, .^iidby moitiplyir^gthe dificronco by srtotaf/nb. ir> otr.cr words 
the weslcd pcntiuium's ZMP » d( •cs^-.ioo =• Orticul.itca by subtracting the produci obtained by muftipSymg 2^.. -ect 
(correspond-ng to or iadicat.vo t-s «g ^Vlf , by a rat.o behvson the teg's macs n*.8t and the body maleris! point's 
n.«s rrD 'rotn !hs p.cnSuct obEa.rcci ov .-I'.ii^ptv.ng trs dosiwd ZMP by Sk ratio of the robot mass miotai and the body 
na-sism! point's mass Enb Tbts oroc;oss.iq corresponds to the proesssing ot Eq, 3, , . . , . 

[0102] TJw bmawr of ■■r^^-^'^^ pr^f ^^it^m (s exprsssed by Et?. 4 Tt^s inverted pendulum matenaf posnts han- 
?on*;5' po-=i(ion xb is determir.sn or c.^lcuiated. 

[0103] '^u'-ther 3^ (iiust'«fed m Figt-o 6, the dynamic caicuiator has a body position determinator 202 which deler- 
t "-^0 ^.c'l/onta! bo-dy pos->"Of xb Spor.Sicaiiy ihe determinator 802 detanninea the hofizonta! body postSioR \n 
£ucft"? way that the hoi./omal pos.iion of the booy-rooresenting point OBustrated in figure 5) is equai to the horixcniai 
position of the inverted psncsulum. 

[0104} Next, the gaii tor naintainir^g posture stabtltly cbntinuousiy wii! be sxpiained. 

fOIOS] The dyf^3mic mode! itself doos merely caW.m the body trajectory from the desired 2MP m sucn a n^avmet 
'•^at 'he dyn^T c f-v-m o^-^d*o- c*' f k v..^-^^r• f apnroxirrateiy satisfied, H can not prevent the body tra]ecit>rY 
*'Ofr dt -'<^in'} ■ ' i from deviating Srom a position corfespondtng io the positions 

cf ihiJ feet 22^! ' - , . . ^ 

[01061 !! w f! fion o ? i,^oi.'^^t>d -)o\\ the 'c .li^om.^^v oe-wsen StiC body and the fee! iS appropriately ratamed so 3S 

101071 ^ F w .ST.-! dnderstancing the nature of the linear inverted pendtiSum that is ospeciaily signifsctint tor obtaimng 
f'.U e body t=8iec=ory anatytfcalty will Ursi bs discussed The exptanation will be made with the use of a discrete-time- 
sertes inodel- 

[01 0»J Variabtes and parameters Wfli be additionally c^firted tor the tnveited pendoium as follows'. 
wO Tituia angj's' f'e<!.i^rc\ c" nvo-^'ri ps'^ditfun 
At. s.ampie time 

X Wt ■■"\--)tt [jp-!CiLi'jn i. pos't j-" at ^ t' ^ ^ep \ini!w ^St) 
\\k' ive-le-: p-f xUvJt" S v?loc iy cs! k in step tiirnt; k.^v) 

.-VS'v^or il .c'-^.d t.er,du'UT. . 2N'^^ a ^ ' - ^^^^ ¥ ^ ^^^o-fefi th s in. o^t . nod Dy 0 Order 

hO'O'rg XhQ ZMP^>..'PC!S!si is ano is i^ept -^pmcj tro-r tcnc kSi lO tJmc (l-^ \)M More f occi .eel y t >t arsur^od tnat 
the same s=gr<a( is kept inputted to the snverted pendusurr. dunng that time oi pertod) 

[0109J Fiirthef. values q[i<1 and pik] are defined by S as foiiows: 

[01 1 0} By dj8Cf0fiz{og the equation of motion of the inverted pendtiSum and by soiving with respect to qjk] and p[kl, 
we obtaiii Eos. 6 and 7, in the equaSonis, "sxp" indicates an exponentiai function (naturaf iogadthm). 
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p£kHxp(-(aOicAt)*(pj;oj.,(cxp(«OAt)-l) |] (exp(i«)OAt> 

qtk]==exp(a»0icA0*Cq(0Hexp( -«OAt)-i) ^ (exp(- iaiOAt) 
*ZMPpend{i])) 

com] The meaning of thseqijalionswt!! be tiiscuased 

fnyzLpni'""' '''' '""^^ ^^"'^"''"^ ^ ^'^^^ ^^'^^^ ^ '^-^-^ constants ZMPmia 

SwUlr"''"'' "'^'"^''^ '"^'^'^ "^^^ -™ 0^ « H,. a. w. Obtain 

*ZMPnjax» 

roi-«41 From the theorem of mm of geomstric sarins, we obtsm Ecf, 10. 

g 8xp(i£»0At)»(l - expCkaOA t» /(I ~. expCoOAt)) 

Ecj. JO 

mn] Accora-ingiy. ^A- 9 can be rewdsten as Eq, 11 . 

[0116J Sirniteriy, from the r^taiionsh.p between the feft lemi and the middfe fm> of Eq. 8 into Eq, 6, w. obtain Eq. 12. 

m 2f sxp( -wOk At)-*p[0)j ;t - exp{ -wOk At))*2!VPfrin gj,. -,2 
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10117] r Scc.w£.f,^M^'adL«!yapproA(nc<ittcCw'K'-F,k - lin > "Oj> M iic! ^Pshow^M 

[01201 els'- or nd(d ^"^ ' ^ - ■! 

[0121} ^ -J -se. 1 /(inps i. us ai-im d c <^ f-tnt^ t i i 

apsecf «ctl=int-rTO D**'T«5theJ'*>t rf«tfmc J i-t, -s-^ ^ . „ ^s- >^ --die 

to 2WP0 if! a qeometnc serses manner, >f qiO} is ^.MPO, 



[01221 -eremafter pjk defnod by Eq 5 's feferr8<< lo dJ, "oowerqen, compononi" qfkj smtiftfJy dof ned by 
5 isreferfecjtoas'-asvsrgenicotnponeri! . v-n .r 

[0123] from the above tt ro< ^c^ m tjf^. lo avoid dfvetqencv o i p b 3\ f^i« k ao 
eppropodte positional relat!^--nrt Civ. i th. rody .ind oo) ^hscowergcn -omi , « ^ a- 1., - it c 
end what is sigftificant i$ mai )o controi im fsivorgeot component sv — - * 

ensures robol waifeng. ^ . 

[01241 Mora specMiy ,t >s mpo'^<3->t to detem.re 't/P ^ y parameters cod othe^ 

L.^.eo.s«ppo.>«te^ . . t e dv^ gont component does no* exceed trc rfnge iMl -.ores fQtK)tw« 
- - f •^fC'' *hf(l r.rwp!^^'' p^stu re from deviating markediy). Unless the body behavior e mada linsar m the pfesent 
:.„ ..,-;,,..p ir,v^s iPBo^sibl!^ me Drior art to ma equations where the divergsni componeni and ihe convergent 
cofrpo^«trt a'-s ssp? rPted like Eqs. 6 and 7. Thus, it was not possible to make thsse discussions sn the prior art. Now, 
it becomes posstbse tn tlDts embodiment. 

[01 25} The nature of the converqent component and dsvergenl component «)H be expianed. 

Nabre 1 : Sytrinx'tfy 

[01261 The diSfsrei-icQs between ihe eqoaiiot^s for obsainin^ the cowergeat coiiiporjeot p^k] and the divergent corn- 
ponent m is that pM ts repiaced with qik] and thai wO is replaced ws!n -ttfi. 

Nature 2: Etsuivalcnt conversion 

{01 271 Since ihey are symmstric, the divsrgeni component wi!! only be discussed. 

[0128] Sopposins as an input a pulse expressed lay ZMPpenc^'O] =^ UO and ZiWPpendUl - 0 (i« 1 ■■). ^m « tf^at 
case is obtainoG &y substituting mis ZMPpendft] into Eq. 7, as m\i be shown ir^ Eq, 1 5. 

qfk3-exp{»0k.^t) MOMexPt -^^At) - 1)U0) Ed- 



F-oni this conskSsrins the inf iuence only upon the divergent componsnl qfkl to input tti« initiat putse UO will 
' " ■' '"dtherwerdsjhe 



brine >Ke same influence otJtaSned by shifting the snitiai divergent component by U0*{exp(-«OAt)-1). in 
iniii^i oolse is equlvaiantly converted into the initial divsrsent cortiponent by muitipiying by (expt-<oO.'\t}-l). 
101301 Ftiflher considering the intUiersce only upon the divsrgem corr^sonent qfk} by comparing Eqs. 7 and 15 With 
each other, infiuence caused by inputting ZMPpendri] {i=.0.1 ,?,..k~1) wiii bring the same infiuence as that obtamed by 
the iniSa! pttlse input UO defirjed in Eq. 1 6. 
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(expC -uOi At)* ZMPpendCiJ) 



... Eq. 16 

[D1313 Thus, the input ZMpper^dfl] {i-0, 1 > 2. -k-l ) is ei}ui^atent?y cowsrted into th« ifiitiat pufse input 
Nesiare 3: influence by tinw cfofay 

[0132} As msirem^ in Figyr© 9. assun^ing tha) 2^4Ppsndn} k a Mon f(i), and that ZMPpendtil is a function ffi- 
r^t) which ,s obtained by deiaylftQ the tmcik>n f{i) &y a time rv.At, ai^cf (ieMng conversion of the input series ZMPpend 
V] <nfo me mftiai puise ss UO and conuerstor of Ihe inpat series ZrrPpeocJ'O] into the inHiai pufss as UO'. UO" wii! i«j 
expressed as Eq. 1 



[0133] m oshe- words, !he same waveforn, is is^putted by delaying by the time nAt, the divergent component imuced 
by tne input ts a va\m muitipitsd by e>cp{~rn,,CAt}. 

[01341 "hon . « divargem component obtained by irpuKing complfcalsd waveform of the inverted pendulum's 2MP 

tmotne invoflec pendulum node! iiiusuated in Figura 5, 

P135| Tte 2MP input <5,ven ;o the inverted pensjiun. ihe dynamic rriode! fiiustraied in Fiqu-'e 5 io^ Pa * i. a 
difference bet^s^n tho product o? tt,8 des.r.d ZMp ana f.to;.i/..o, and the product of Ih. ieg ZMP and rnteM, Si^e 
t^B desfred ZMP « speciffcal^ sxpres.sd by a waveform of broken line, the product of the «esif©(} 2MP and ffltOtai/ 
mb IS simiiarty expressed tjy a waveform of broken tine, 

fs!f Ik"^^'T®- ^'^""'''^'^ ^""^ aoafyficaSy determine ihs diverasnt co-nDonG n! .nducsd by :r,puttinq }i,e 

^MP ot brokeR-ime wsveformto the inverted pendufum will ise explained, (T he influence of f he ieg IMP wii! be described 
later.) Actualty, the inverted penclui.m s ?MP moves en s two-fjirmnsiona) space (horaeniat piane). However for ease 
01 undersiiindtns, is assun^ed that tne Zt^p moves atcng a linear space, 

[0137] let us suppose a broKen-iine as iiiustratatf in Rgure 10 as the waveform ot the inverted pehduitjm's Z!V»P 
Penoo , !S oofined as a period of time whose tength Is periodpj and the irvftfef value is mm The prtncipfe and aigorttnm 

10 ooL^in She o;vergeni ccrnpofi^ni gensjated by this 2MP wiii rtow be cxpiaiE'ed, 

[0138] Let US define a value as H(T(t) T; wtjich is obtained by convwting a divsrgeni component (generated by 

T^I^^^^^TuT"^ ''"'^^ ''"^ ^''''""^ ^'""^ ^-^-"^^ '"^^^^^ P*''^"'""^ of *e inverted 

p^ntiJtams ZMP;, .nro n^agnitude of puise inpuited si time 0 and time width is a sa?npie twe -it 

f!f^t\,^'tl^;^' 1 ■ ^* 'f ^'f'^'^'^'"-' ^'■^^^'-^^ -^""^ ceiculetion shown in Eq. 18. In the equestior., indicates 



mmj> '£ (kAt)exp{-»®kAt) 



mm] The inverted peridulam's ZMP's v^ravefonri in f.-^e »s;nod ; can be c(iS5,.;;ivaci intr .i .cep-i-o wavef.-- snd a 
rarnp-ite waveform each having aoetay, es illustrated s.^, Figure 11 Acco!dtf>gly. i-j(f.;t) T) for ihe's^^eo-iik- md ^amc- 
ffke waveforms shotild be deteniiined beforeharid in a manner men!»ns<i t>eiow 

tei41] Specifeally. describing him. T) of a siep-iike waveform of K^f(t)»i es H(f . 7), it wili &e expressed es shown 
in cq. : 9, using she ihaoneni ot sum of geometric scries. 

H{1 ;TH1 - cxp( . Mt)) / {1 ^ expf -<»At)j gq, .| 9 

[01421 Describir,g M(»{t). T) of a ramp-iike wavoform of a$ Hft T), it wii; be expfssssd as sftpwst in £q. 20. 
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Tthf >.ni r ! « t H n, li. thon t-ha-Kjeti to » idble o <la Tha va ue f{({ } > 5 n ine above -'d^ Ah:> 

[0144J Having conducting these pmpafatO!^ procsssmg, a value (hereinafter r^f^rtsd lo as "W). whicn & i..bta,neci 
by co^vesiinq a divergent component (generated by the mveiled pendulum's ZWP iltusti^ted if> Figure 10), into mag- 
pi'tide o« tnvc>rt<'c! pendulum's ZWiP ouise (fipottect at rttrie Q arsci the tsine width (S e sample ttme At. 
[0145] f ir<!t If ■> "-^ otcl p-nduturF ZVIf' f --a ^^c c 0 1 b > oonvortod trto the 

naqnSL-cioofac <^ ! -p* t . -.i a t.-nc oU- « As .ffuMc! 

r f gurs 11 'he cf-f r ivof c ^ ,>t iduiu!- ^ 2V^ , '^«> sUTJ of a rsjctangtiar 

waveform w>iO&e >^&q^l « ZMfW ano w^oto sto^;^ * (ZMf'i .vi) ZS^Pi o-i , p j s« cj>vSfSK>n vatds be 
ss snown by £q. 21. 

inftfhH{1.periodpi)*ZMPri] 

[0146J Then, itifiuence of the inverted pendutum's IMP during the period {i Ri = 0. 1 , . ..m) stiouid be convstteS into 
tt)e magrJitude of a patse inffij inputted at ttts iniiia! time ot she period i and its time width is the sampie time At. From 
nature 3, the puise conversion value wii! b& as siiown by Eq. 22. 



...Eq. 22 

pun influence of the inverted pendulum's 2MP waveform during ait of the pertcds ilfusirated in Figure 10, wiii be 
ti)e sun. o? the ir:tiuence o1 the tndividoai periods, in other words, the piiise Gonversion value W is calcwJated as shown 
in Eq, 23. 



„.E^. 23 

[0146] Prom nature 2, when 8(juiv.g;ief)tly convertiftg W into an Ntieii dfvsrgent component, itwfiff be as shown ir> £q, ZA . 

[01 4§3 FrcfTi Eq 24 or nature 3, when equivafentfy converting W into the divergent cornponerit at gait ■ etminai, it wttf 
bs as shown in £q, 2S. 



Wsf (exp(-oaOAt)- l)*8xp(«>0( J period[ij)) 



16 



EP 1 361 027 A1 

app'opr,^se.ysuoh if th. d^e gt>r.con^on,.>^t *>c . noj excseJ she r^^go «ut ensures mbo! w.. kiro 0 a Z J 
trtat prevents poslure iram deviaiing (iia; hed!yj. . < v- « 

I01S3J Next p»obeP^.Mh«refou'»50w to oetemipc the r^nge that eoiUfOfrot^VA^^Kr.^ ^no,r,o -.f 
tne sJwergerst value -i-t, -a.jk or 

r0154J The qa-t ({eneMtor 100 according .o tf e c-riboo nem detetn^.nos a.. «po,ooraEC vaLe / the a.^^'-t-n ccr 
-h"'."!' l^"' 7"' ^ " >f^«' bo corfn«..o3t.acurcnt^.motj^.tnowDcrgsc™d 

.\ o """^ ""^'^ ''^ * '^'^'^'^ ^'^f^''^*^<* as "s'oacfy t^rnmg ga,!' and w„t bo 

[01551 ''is.^'-^' -nr. - fif OP O-^i'ic-lo <OCs%{iU f^:<psi>tednaetai 

tO-..6] T.. . c=..^r,,t.oo.^co'syn...p. ..^ .... . 

co„oct.d so as to ensur. oontnuous w. krs H.r...ner th. ga<ts b.,ns g«n.r.ted s ir4d to 2 iJ^n: 
ixt LTi'tnTS" '''' " '° '''"^ ^"'^ succeedmg thereto !S reterred to as 

' f cv< UM^r M T - SM wb«h t,n.er .nterrup* at .vary cont^o. cvcte .s waiod 

^f^'.orog.an^rocoeastcS'C ' - ^^^^^ ^ vvho ^crss.ftsOTve 

[0159] W'^en*'-9Dngfampfoce6clstcS-,8 t^G t. T,e « r .-^ga < V > p. oa^ , r ^.^^r n i c . , 

wn,eh a -.ext ttms gart's supporttng leg coofxiinate systen 3 nex» bu- c^e !, t,«; s «.ppo,t,f ^ n j,' ' 
snd a ccrren' Sine g^tt period «nci ^ next tsme gail penod o e .«ad rh«'e va uss ■? s coif-s i - a i ^ , r 
d3m=,->d They may be sto^od m the ne^nc^^ as a k.r,Q scheauie -^ay bo de^errn.^ed D.sed or" a. .^st^^a o-^ 

" * ""^ proceed, t... o...>H in ^ast parameters of the currsns time gaft are prpvisionafty tJstsr- 

rexttrn88ri{'ssiippoftingtescoordm=jtesy3<^trv,e«t.dfm-nrh«c..'fcr !Toq«i. .ppor ^q.eqco. J "^-j 
Spccif,ca'y thoy arc> dolormmod m s.ch « way .h<il She foot po4.«,on a«d posture ot the frpslg fo« 'M'^^ -a-^'^^ 
olat^d hof,.omaiiy w.t^^ot J>vo .r. to-m.nai pos>t,o« and posture .hecurmt ga«. while koe. .c? comae w ^h 
(.je f.oorj w.ii smi >o ^fie tiex! gafs s aupporjtng teg coordinate systmi\. 

^ .tA„a,'jo- fjf^rtat r - tA'"' ^'ni'' " V t ' irif qoi'^ z^'-Kf ^ sup-f-- .'ig (eg fop! 

r ; '^-^^o^ --Minimum conve. polygon {me so-csiioci supporting polygon a«d is 

' (19S8)-S6061). Ihedeterminatjon cf cu'rrcn! time gaifs ZMP 

ire subjecl to oofroclion as will be sxplalnecJ iater. 
whfeh gait parajTHjief s o! the steady ti^rrivng gait that ts to be continuous 

!y in motion at 
if; the rate 

ig.^= advance" in "iy s ning ' -.n a tuQ^ setiss, im Steady iumirig gait ts insrat 



;At;r ' ■ ''"^ ^'^^^^ ^^^^ ^"^J«c^ ootroction as will be sxplalnecJ iater. 

[01 6A] Ti-:s progf .srFj jn^n proceeds io S23 «i whfef; gait para 
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cy she gait qm&n-.xo'. 100 teniporatiiy or tsn!ft!ivGiy in order SO deSsrnin;; t?-,e divergenl component at i-ie curteni ga;; 

";n6.!O!0ie. ^ris s-eady lumifrg gat! is not ojtpjfeo '-c-r :h; g=-M cjcnsratorlOC. 
r01S6j if;.ci.-cE=jiiy when roiiowing tiieafcJ^tisairi cishr ^-cr .i-.a: -.s-f -i.- ^ompnsos one walking step tnat sis^rts a! ihe 
oe-giriniiig .if .i two-iAcj SLippofling period «nd errts at tr^-si er:G cf :r s •.: -^j-icg Bupponmt} psrioc succeading '.rieretn She 
c)..>.it nf:.-ci<; gaits tortwo waSking ste»s Aitiiouqh i: c:os.£i&le to set the steady turnips gaft ot a compSi- 
l?nea fo-rrt; risvifig sc:! 'S< qaiis for shsee watkisig steps or rwic, ^-.ch :i oofiipiicaled gait setting i& tedious ar>cf ihe 
Kdvwniages m<i «fSecls are lass ihar. axpecsed since she steady turnirsg g^itt w 
corriporrent at tlie terminal of the currem ima gaiS. if the fegged (nobils iotsoi 
gaits to define the turrslrig wilt be increased in response thereto, 
[0167J in tt^e gait sottirig. botindRr>' coriditions of ti^e isg trafsototy in the gait pssraTsa^efS oi tr^e first tLirrii-ic; qmi e^ia 
She socvjnc: i-jw-riq aah «ro aol O! oVitorminco such ttiai the tog irajeclofy is iTsarfo .-or>;iri jous sn the cidor w n-c cut'ont 
time gsi't !'ic iirsnurnin^ qai! and ii-;c socor^.d ;ur!:;nc gait Spoctflcalty, the imnr- fee ios ;=o; position ^^nd poisturc of 
trie tl'=^t fLiintf^g .jar so' ;0 Pt: tha ■ermir^a! s^ippori ng iog foot position and pc&ior^i c: r.-j:rent i;n-iO gait viowerd 
from the non tit^w q.^it s c:ootd;.-^.=it* system. T r,-s ir^.tia! supporting i«i9 posit-oo a.nd posX^m of tt^e !i.s! turning gait is set 
10 be tne current ^WK^ g^^ifs It-rni.isi irce ssg pcs:Pori «r^d posture viovvcd from the neifE tifrw gait's supporting leg 
coordiftSJte sysiortv 

tai68] Thfi termirtai free ieg foo! pdsilio'-s and posture d tne firs! turning gait is. si-niiarty to ti^e determsnatton ot it\fi 
curreni ti^rse asifs ierminattrse teg position sn6 posture, set or delerminedirt response to t^!e nsxi but one's time gait's 
j'jpponing tag coofdif»ate system viewed from the next time gaifs supportitjg (eg coordinate sysierri Ths iGrrriif^a! 
supDOftiH^ ieg position artd postiire o? the first turning gaii is foot position and posture obtained by rotating, whife 
keeping floor contact, the foot (set to the next time cjait's supporting leg coordinate system) to be brougnt in surface 
contact with the floor so as lot to s-hp Tfiargfore it trie tionr suiiacs iS flat the terminal stippcrting !eg posilton and 
posture of the first iutnirtg cait beoirr'^c ijquai tc th-ose irr ttsc next tirrtc gs^fs s-jpporting teg coofdirtate systerr*. 
i:0169l Tiie terjnira; free ieg foot Dositiorr ,v\-i posture of the second lumir-rj gait ars set or dctermirted to be the same 
as the ierrtiinitl frse ^sg toot position <:'^d ^.c;."u c o; tr « ci^rret; gait viewed fforr^ the curtent time gait's si^porting ieg 
coordinate system. Tm tern-,ins; supporting ieg tjos ;:cn anct postijre of the second turr^irt-s gait are est or determined 
to be same as tnose of the su poo-ting ieg toot position and posture of the current time gait viewed from the citrrertt 
time gait's supporting ieg coordinate system. 
[01703 Figure 1 3 ill ustrates reiationshtps among these gaft paramefsfs, 

[0171] The first turning gaiS and the second turning gait have the same waliang period as that of the next time gait, 
(The waiing pehod shooid neceseariiy ba detenrrined to be the same vatue, but should prefetabfy De deletmitied in 
response to the next ttms gait walking period.} other motion peremoters of the currani time gait, the first turning gait 
and the second iuming gait (induding ttrrte pararrictors such as tvi'o-ieg supporfing period's length) stiouid be deter- 
mined appr-oprisieiy in response to tf^e deiatmined parameters met'tiorted above in such a way that they satisfy the 
coiifjitlons of gaii (e g ihe vefocity of Itie etecuic nrioto!^ .Jactuatora) are within permis«it>ie rar^ges.) 
[0172] Tiie ZfvtP t:«jec!oty prfr;imeters of ;iia ihs'- ti:sr,r-g gait ana tiic; second luminggait shotifd be set or determined 
sijch that -hey hav;? (--qh rnarsin of stiiOiiit^' nu^i do not v-haogft aiinfptiy 

[0173] Aside tro.'i- ttie ?.tx;.ve. if ^n^tiai position and vei:;.c.ity of trre bQdy-repressntlfJS position are set to values XO, 
VO after having generatod fhc aforesaid first tutntng gait and trse secortd turning gait with the use of the simple model 
liiust^aiGd in Figure 5 tne in.tiai position and velocity of the body- fcpfesonfing position when tho first fuming gaii gen- 
eration is again started, become eciuai to the sal values XO, VO 7 he values XO, VC are hereir^arter referred to as "body- 
representing point's initial pesittoR/velocliy of the stesdy turning gait". Trte valtie XO shoijid t>e descriood as '^xO. yO)". 
but the description ot VO should be omitted. 

10174) Wstn th « >A»-^r the ;ir<>t t:;rninq -inr! the seoc:-!d iUTr^int; gt^if aro genefatf=rt rftps-affdly lining thu sirrrpie 
modsi ittusfrated n ^ t.i < - i'^^- i.-.My :-:D^--.= 'i;:--^;.: v -r.-. -.r.-.-.. -.i t:-.;:^ arid vsiociiy of ihc fir.->t t;;rning gait are aquai 
to the values XO. VO. unless timers are acournuiatad caicufal.on errors, in other words, the contlrvutty of walking can be 
snsjred L'^ivotgf^iM f 'if-conent at this me. i.e . XO+va'(avO ;S hereinafter referred to as "steady iuimng gait's initial 
dfV(;rqeril component . 

f0175] qe"jr.> rig the sxpianailon of Figure 12, the program then proceeds to S2S in which this steady turning gaii s 
initial divcg^nt cot ponenl is determined. 

[S1761 Figure 1 5 is a flow chart showing the steady turning gait's iniUai divergent cotnpooetit at S28 of the flow chari 
of Figure 12. 

pji 77J Bef Q! e entering the expiaoation of the figure, a principfe for defermining or calcuiating the steady fuming gait s 
initial divergent component will fee mentionsd. 

{0178} ?rorn Egs. 3 and 7. it bfjcomes possfele to obtain foiiowing equation { Eq. 26): in the equation, the desired 
ZMP is dsscfibed as ZMPiotal. 
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-»-cxp((aOfcAO*(~exp(«>OAt)~ i)| {exp<-«»OAt)*mtotal/mb 

*ZM]>tots}a})-expMk4r)*{~expMAt>~l) (exp{-io0^t) 
* mfeet/mb * ZMPfectp]) 

^ v!^ ''^ ^m! T^'^'^' ««PP«rtfn8 teS coordinate system of ihat gait However for ease of 
■ a siDsts gait {steady iurning cief^) ^ ^'^^ ^^^'^"^ "^'"'"S conssiiuies 

t^m. Of si.ady .uming ga^i. a^^^^ ^ .Sr' t^J^: J;::^^:^^?"^"'- 

[0181] IniWs aquation, ihftr^t iirs( term indicates the ts-mi^af div<^r.»n( <-on-pi«T> inr- •^>hk^,.k • > 

dir83f.of5s «:w.<^ssi,d «s w^n.piota> . it ,s a vector m swo-dimension defitjetJ by Sis X and Y 

lot 83} Then , the iamm divergent component induced ^y the leo trot^on .« if<rt*wM»rf « , 
98».to<tetermlr«2mPr««8?i«o 1 k) fmt ^ T . l'' ^'Tf ^ ' of ^ luming 

iwifwj ffevasue, thus determineci or obiainae is expressed as "Wf set" tt i» a^<^,^ J..««* - 

by tm X and Y (jirecsicns. e^pres^ea as wfeet . tt is a!so s vector in two-dimsnsion definsd 

t0185] From the above, vis obtain the toflawing equation (Eq. S7): 

q[((Mxp{J<,.>0km)*S}[D)4W2mptota!4-Wfset 27 



1 01 87] , t I yp, ess ' -5 -5 ,rc « oof J - . c 
! y^lc r -9^-3 -1 3; v owci from ttie si.oou!Hf g i - - 
sy?«ei- ,,£rg^,c13) by8(v>^<^Hor!rna^.tx^/SinciC4!f , . ' » ifs- 

3 .nci.,t.n9 1.. on, ^ oaorc. na>o of th. .wo ..t. .vster^ ,t w i t^r^s ^In ^ -hi '^J.^! \\ 



^ ht s>t<' t(<y I 
1 1 tr < Vid, 
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gq. 29 



[01 SS] 



Eqs as and 29, W8 obtain Eq. 30. 



Eq 30 



J01 89} Further, f rofn Eqs 3Q and 27. we obtain Eq. 31 . 



t ; * q[ 0 ; -f- mptat ai ■■ Wfeet 



Eq 31 



[01901 When expre8*<i>s the inverse matroc of the matrix A inv(A>. we obiain £q. 32 from Eq. 31 . Jn th« SQuatk 
fs i indicates a unit matrix. 



20 [0191} Based or, ihe Drincipie of detemtmatior^ mentioned above, expSstninq the steady turning gait's initiai divergent 
cotTipoEienl mih reference ta tim fiow chart of Figure 1 5, the program begins in S1 (XS in which the temrtinaf divergent 
component induced by the desired ZMP is determined in the mai^ner rr-emionsd atjovs. Tha program then proceeds 
to S102 in Which the lerminst divergent con^ponesit induced by the ieg motion is determined using the right tliird term 
of Eq £6 and to Sf in w{-<ich the steadv -urnrnq asit's irtiliai dtvergerit cornp-jtient qiOj is determined using Eq. 32. 

?5 The Steady turninqo^^^ i^-. *vo - , o is a val^e viewed from the supporting teg coordinate system 

of the steady turning gait. The pro9ram thef^ proceeds to SI 06 m which the steady turrting gait's initia! divergent com- 
ponsnt q[0} is converted snto a vaiae viewed from the sispporting leg coordinate systesin of the current time gait. This 
vjsitie » named 

[0192] Ttie next prcxsesstng is to correct the provtsionaiiy-detarmined currertt time gait parameters such thai the 
sc tsrminai divergent component at the current tftne gait becomes eqtiaf to q". Since the processing is aimost same as 
ihat in the steady turning gaii, the variabies, vatues and syn>bois wili newiy amended to ias corresponding to those of 
tiie current time gait. ^, ^ . 

[01 93J m this er^bodiment. the parsime'.ers correction is to be maae only for the ZMP trajectory parameters. Atthotgh 
the other giA parameters may be corrected, sine- ibe relaUonsl^sp bef^een a parameJet eorrsotion amounS aod ihe 
35 t8ri«lr»idiver«5entcomponer»tbecofnetMio(maliyr,or,-:ir,ear.itisaccardin8iyimpossib!etoob^^ 



the provisional desired ZMP t- the ZPU correction amotint. 

[019«1 i=or ease of linderstar^dtng, afi variables are assumed to be tineaf in the toiiowing. 

[0197} The ZV5P correction amount ts trapezoidaf as shewn in the middie of f^igure 16 a.nd its height is sKpressftd 
«s "a». Since the relationship baiwesn ihe desired ZMP and the tem^fia! divergent component is iiaear, the ierminat 
divergent componertt W/mptotai indyced by the desired ZMP pattern can be expressed by Eq. 33, 



so [0198] ir) the eauatiOEV. Wxmptmp indicates the tefsninal divergent cot^posienl induced by the provisional desired 
ZMP otthe currem lime gait, Wtrim Itidicstesthetetmir^a! divergent componeo! induced by the ZMP cofrection amount 
when a is set to be 1 . They are obtained or determtned analytically in the marmer of daSfirmining the terminai divergent 
component induced by the desired ZivtP pmimn of the steady tumirig gait. 
[0199} Since the terminai divergent component pfk] is p". we obtain Eq. 34 from Eqs, a? and 33. 



g!:0|"if!v{M - exp(<j)0k^l)IKW2mptotal+Wfe8t - 3) 



Eq. 32 




W^mpsotakWxmptmp-asWtfim 



Eq. 33 



q■'■sxp(«>3tcA^)*q(a}^W^mp&np■^a*W^hm^•Wf6et 



eq. 34 
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ZMR ;he tem,nai dwsfg«nt componefi) of tfie cormm time qait bmes 
i. J. /e.9e!n composiem of the steady lurning gait viewed from the curre-r^ {fvs 

i^- qd,t,>r,^. reeled w f iiy.r f/ ^ 1- '-'^^-^-SfiTj proceeds to S30,rwhc>, he cure"* 

t~fci,vegentc.>^,o b-^ nc^ . , . , « /-'-^c od such t^.t 810 cun-eot J r,.o g.,rf s 

I0">04] ,ra ,1 the prog.atr be^in^ ,n S^OO n } - e n r^^ u v kk n .r>* ' 'I' " ^ 

[0205] .f.r.gfi^t.a Dr'^ce-cJc , S^04 m w^<ch t^e 36 mma rfv^rgentccn f ,.w.-^e . . dbvt^ot .r r 
' ."V^""^ ^^'r^hfch the currsm time gaits nt.a!dvugcm .erioj^dec 

irNn^n no u iicv-'' ^'''^ ' ^ '^^'^f^'^et^ssired 2MP patatjoteis afo corrected 



% t is 



[0207] Rettitrtina io ms ^.xD'?'v'^ti'^^ of Ih" f'-^-v - - 



(021 Oj 



[0211} ;r!f> pfonram ... : 

peiouunshowomalpos Specif«:%My asmem.o.e v . . «d . ruhe nvered 

f-o<r) . hof gonial Mos.* o-. besmes to .he hcwrcn.a ^.o- .,on ^ the , , ^ ^ T 



J .^ji.^ ™ uciD>it<»iuu uetiig rReirsoo body 

S,onc 'ncprZ^T^tt"':'^''?;''''""^' t.opogamp.cc.0. ,oS3. ^ 

mm Add^». > ^-f^^^-'Y^' -teSi 'rr..^M^^nc.edu.csm«m.on*d above 

i3«>«! fca 9af! < r- n a^ o 5^t';eTiaodmentwth'efef6ncs*oFiq«re4 

[02141 Tne res* of p..mmctm ficludncj the dt^srsd a o.^tu,D t ^..^ar^n ^ t^,. . . 
' . o 0 J . '''''''' "h.yare.(sos«m o«dos.r.dPc. re'^.or fc 5 
, '■^^^^^^<*"f<>^^«''edetemned«^ddrese'^UomeoDr<pos.tero™i.r- 
. , sr^ , I , , . „ T 1 0 * '0 mc roto* Qtonr^t so -lodcf 1 o, « ^ j 0* ^ cJoss 

-JtspfavOTo « c. i'fo ^ j8 rct^cs re ^m^^sn 0^ the twcJv, p ots o ' * ' 
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, I 01 ■> e ! nucoii fft t K bot "'v " ' }ete«rt8Cf b) an sctmi foot floor 

5 or o cfso '=4^ ar scoiio tl~& Gon osd*" i,ot e 

J , , PI t icmo ion c tj ti t i '-ii^ tdination ssfsof 3b af>a WO 

jyg J oa > t- btoi^ifii 5 (01 cot^ Jitt-C <; iw it^K 5 ip nsrfmqiotaitioorfc^vtiortrtvesn^omem 

flBout «edossfoo ouinoo t^auoifjr iraipom oLu ««c!t pob it'; tjt action and s^u no thecal oosite 
orrfKdn eopyrciondUtn wlof i04 -"h dr o Timdlo 104 orrcas, «io cte*. tso v<tiui.(s sr esponselvtt n»iu f-U 

t0217J ^mce oe qtfc o'U(ei;vseoJ n\.enior esHlesii iioobo gatqensa ofinihegdtgci(-(iio lOO iitls 
the conf^9Ur8^io!^ and opsfation of the other componerts such ais the cornposse compliance oparaiton cleifcmsindiof 
4 o jo "^eci I detaii sucf- ' tn apa le&e a d Ooen r c' *ii>E Aopf ^t <jr Mo -f«t 0 {1 «?qS) ^77964 pfooosecf by 

ihi- fiLsplicanf. no iurthef oxpianstion vviii bo maao 



^.^r;r.. 1 1-,,-- n.-jnfi:ftt:ion systom of a iosgoe mobiks robot acoofd- 
t « -1 e c !v,i,r» 0 d p obfems of J^pjot t <- c r-t 

iij <58 f*^ -Jl o -^ObCtJby tne -ippiicduea et xind can gerera e a g i of-i v i <jf^ iv ^ 

V = } It ijatFf es tlio t,yna«iic equslb bm condt'son ffi&eSy and on R rea nn© bnats i 

^ ^ ^ ! v< ^-i h (»nsvjrc>-5 ihe d <hj arement sf-d voiocfty of f^rh part of the tobot v.ortmu'> }<; a 

boundafv r^eEwMin next ga»» . . 

102191 The«e wsii be discussed more speoifical y Rguro o ^ a si e c*iafi ov^ ig e raje s -v ts d & 
if q point in he Y dtrectton it e *e te*l and tgh atrectton?) The gsd genet^t o v:,t jm of =i Icq u i oool 
c-ordmqlothfSP'nbodimemcrfoqe-serateagart fist-h tt^/t^^ ! ih cody r p e-^ c (mlU i> --e Ive 3 o)^ B 
gradually aDproaches or converges to the footiy-representHig .raifJciosY oi iha sieady luuims vjaif tK)-ifr,ed l-y A,. 
[0220] Furthsr. sines the system simpiify the dynamic model of ihe teggsa mobile so as to enhance m Imeartty. it 
can generate a ga« by oredieting Mute robot behavior. Funhesmore, since U can generate any oiher motion than the 
waiking rjiofion on a reai-time basis, it cssn n^ake th« other moiion lo be oofJtifiuoos *fti> the walkmg motion. 
[0221 1 St Should be noted tntha above that the mr ee-material-poin! mods! ifittstrated in Figure 5 is mt afways mdis - 
omii:-ib\e. irtstead of the thtee-materiai-ooint mocsei illustrated in Rgure 5, She ssnsie^ateiiai-poifrt model such as 
^1 .^e . I ^>aflese Paient Publication Ho. Hei 4 (1 992)-1 S068 can be used fft ttits smbotfimsnt. In doing so. it wii! 
bf^ equivaiant to set the vaiao of leg motion to zero in this errifaodinent. Although the aocuracyof approximation drops, 
'<ince me -iivesgam component induced by ihe leg motion becomes zero, the votume of e:.:3teijiatfon decF«ases. 
[02221 m^^'^ 20 is a subroutine flow chart, sinr^iiar fo Figure 1 6, bat partialfy showins ti^e caicalaiion ot the steady 
turning gait's initial divergent coi^ponent in s gait generation system of & legged mobt;© fobot according to a second 
embodiment ot the present invention > 

[0223] It is Stated in the first embotJimem, ttiat, instead of the three-msaerfai-point mcdei, a single-matariai-point 
rriodsl can be used fn the second embosmeftt , based on the supposftSon thai the pertorraance of tiie on-board CPU 
!f<r<;i aiitnrrteiic unit 60) is markedly high, instead ot sha tfsree-matertai-poiot model, there is used lha modei {tISustralsd 
ia F>gu.8 23) in which every link is set with mass. In other words, a non-linear rftdde! is used in the sscond etTtbocJii^snt 

to coriduc; cjBit generation. 

[0224] gxpisiinir^a the ooerallon of the system according to the second embodiment, after conducting the same pro- 
cedures as those shown from S10 to S2S, Via S26, of ihe flow chart ot Figure 12, the program proceeds to a subroutine 
ftow chart of Figorc 20 to datermine tho initia! divorgont component of the steady turning gait. 
[0225J in iho^fiow chart of Figure 20. the program begins in S400 in which the initial body position and vaiocity 
candidates (XO. VO) are provisionsity detenntned. The body position and vo!ocit>' indicate the posilion and velocity of 
tne body-representing point. For ease of sxplanaeon, onty the deterrniiiation m ihe X-difectloo is discussed, Aetuatty, 
however, the position aod velocity should b& soarched i'^ bo!i^ ths X find Y-dirsntionB simtiltaneousfy or separately if 
tr^ey should be searched it; the X and V-direcScsns sirrRiirflncoiisiy. !hs r.pacs of search wiit be a q^arric-dsmension 
corr-prising an X-position. a Y-position: an X-vetocsiy and a Y-^'ciocny. 

[02261 The program then proceeds, via S402. to S404 iii v',hic« a gait frorr. iiie tsme 0 to the terminal is generated 
based on the steady turnins gait parameters regarding [XO, VO) as the iratial states of the body, tising the dynamic 
mode! (the non-iinear mode! iwith every link set with a materia! point as illustrated tri Figum 23}. Specificaiiy, by obtaining 
the desired ZIWP, the desired foot position and posture and the desired body posture, by assumirsg the body's position 
and velooft>' as (XO. VO) , and by usifsg the dynat^tlc model, the body tt^jecfory to satisfy the desired IMP is ger^emted. 
Simitsriy to the Tmi embodiment, the gait generation is made only in Hie gait gsficraSor 100 and the gensratsd gail ts 
not ouspulted therefrom. 

{0227} The program lh»n proceeds to S406 in which ihe terminal body position and veiocity of the getrerateo gast 
are eonvefted into values viewed from the supporting leg coordinate system of the next wati«ng step (the same coor- 
dinate system as the X»', Y-'-coordinate system itkssirated In Figure Ul and deternriine or express the values as (Xe, 
Ve). 

[0228] The ptogt asYt tiwn proceeds -o S4C8 in which error b (orrX: sny) between (XO, VO) and (Xs, V&) are caicalated 
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ii^SLiStf-i'SiS 5i;ic e !>:0. VO; sod (Xe. Vcj must b& eqtjsi to e 
jscomes ^sjic 

Which ft is a&iemmsa whethsr she detorminsd errors ans within mds- 



d..r.>,:.:. dinor.oc. t.c.c.be.ween becomes .«,.r' ''''' " '"^ '"''■"'"^ S""- " ^'""^ ''^ 



[0229} Tno pr,:xii-:ifn ihsn prottSftcis ?« S410 



3 range?. Th€ psf.'niss«W8 ranges in&cases iimtts cf «fion Df tne posiiion and veiocW a< 'h^ 
jy condn.o,... Instmcf of tho pernte^ibfe ranges, she configuration may b.^ aiter/rf to Stllr^Xwl^nS 



£0230] Wh.r m S410 is nsg«iivs, the program p^xics>c^dstoS4^2 ;n .vhid. a Di^^raiity ot .^:!,ai va^^e^ c>.-- 
t-iaStJS, ihe> gasi is qene;;j!:ad cir> ""--^ — * 



i-o V .7. i"^^^^"^ -' ' ''^'^ ''''''''' """^ co.vofti.3 th« gonc,.ic(S g^ijfs terminal body position and vciociiy 
f0231 1 Ti- " ' "> 7 '''3 <:oordinc-;!c sysiom m me next waiking step 

tXO VO^ 'Z S^-^-'^ S iv^-t^'' -Id' '•- ""f ''^"'"^ {XO. VO! am detarrnined based on 

errors ' ""^ " s-»n-.Jtcia!9s ihsreaboijt ijnri the aforssaici 

[0232} These »r<K::edijres are rf=pe>.^!.>ci rs'>*?' -ti- '-'I'-'is - ■■ . r . 

is ^ffir^atVs. rh. program exrts me mpet.ive^oDp iS40S., anci prao^ads^o J^c!^'^ZXt^Z^ 

«^h.ch the .a>r,e procedure as ihat l!!«c( in Sl06 of Figure 15 .n tn. f.s, r-.-nbodrnerV^s ;ct"'-i ^ 
o'Sl o'?S"c?v:^~f;^ "'"'^^ "^^^ ''^ ^^'^ ^'^^^ .mD0d^..r,;.e, lot Lse-^h.... s:no. t.o 

0 dire ; ; Jv;r r:^V;:^,t^^,c T-''^^^^^^ " ■ ««<««=y Of apprcximatiorr. fi « possibte 

9aif.r0 s'rcS ' '''' " '''''' "^'^^ ^^'^ p--"'-^-^^ °f 

[0235] Figure a ffow chart show^nr; rf,p s.ji>.' .ji.r.-= > ! 

ft'^'l, !"ScSl!^^ 'ir''- 'If '''^ " ^^^y ''^^^^^^ VO) «t the 

r^ttJlrw^ 1* ^" pattern ancl th^ other Current 

t0237J ; hc.. progrsmthen proceeds io S504 ir, which the terminai cJiv^rgsmcomponeni er^ors^ra is dotorrri^necS us^-r 

.srni.r.«. .re aete.n.Pod&y caicuiatiRgtrtecurmtimsgait up to she t^mm based tr^~c*esir2zMP obii^i^ 
by corrocung ih. provisionai dosir.. 2MP p«Uorn acc-ordir,g to u.. .oi«i.onsh.p i,iu. 'aL 6 r^L^Ja^ 

c.n.tant of appropriately s«t fine, vaio^, The value a« may J.,c^ ti; /J^m .tC, If f " ' 

vvhh rep.tit,y. oate.i«t!on. Even « is sot !c a fixed constant, the J^/;. ■ . ^ I,; .'^^^'^ 

K'?,.oTe' ,rsrr:f::,.r::? '^'^ ^^^"^-^'^^'^^ ^ ^^^^ ^^-^^^-^-^ -^^^^ ^^^^^at^on m.. 

ZUP pu>>,^-, c'."ril- ^rr" '•^««"sr iiiustratod mep^ is added to the pro«sior,a! <j,:.s,red 



[023$] ; nos.v procedLjrss ar- repeal 

■ ^ y^"v-.ivvtx ». <,.,c..aa,,v.e wui- the curremttme gait parameiors using 

n croei- 50 ftijike the gensraled gart to convsrg© jo the steady turn 

va\v(3 obiained by v: 

>c->!! .^cji »y!ti t!is i;i!rr«-;ni fimfi niiift aonnj^. 

ot ihe above, aiso ir 

case that oniy .he .oJ^Jy^^S,::. !:!:!! ^:=->'- the 

stricier, the parsmetsrs to be correci-d ^''"^ .7^^:.: "-^-'^:. 7 ""V;" ' ' ; f"^ '^'^^ if^e cor,di!,ons wit! bo 



■)« rosuit ia SSOe is fisgattve. Whert the resi>it is affffmajjve. 



; rnodei «nd the gai; is fepetitivety gesierated cor>tifiiieu<;iy ir, accorda'oc'f with jhe s!«adv f -.oino r,«i' 
ru.r,cte-rs in crdei- to ftsake the gensraled qatt to converge to the sSeadv 'u-i^a n , 1 L'^' : ? ^ P"' 

[0241] . V «s'. or m^- atave. a!sc: m tf.j s.«conci emb,:>difr,em, the desired ZSWP pattern in ths qa- 

i fs correcfsd to satts'v !his cofiditior; 

din-isnt, she curtofsf ttrr?© gait pararrteterj 

n si !he Steady gait booj-idary. However, comparin 



1361 027 A1 



[024A] >Dc- -i^rtQ f-ta Ttrq ti. c ~ 0 \ n ( t j v A tt ii -5 f 

jjy f t pq ocit 1 1 ujt. f>y)n\^>"( ti >! « * ^ nu f. « > 

sgeUF^ u rfj ^ rdrKedbyBincrjU» hf>>^civ iQoras©mr>qpQntitaj<»cto(ymvv{jtchthe.v,iiirs itt wqa 
,s q^-. J I t r tt»«ii divo ge.il be ones, stisat lO ^ ard d con! nuo & &<Jit ts tepsli tvefy gernjw to ut. ng 

me steady lurmng ga>i puramesore. 

|;024S} As (Must a'pd t^^ a ecto > e atw it. ;> f am ihf> ^ <?ica'^ y the bound w tt r ru lenl * -^o ana 10 
frsts!cddy»i.rr(Sngqfisi' but gradoaily (if.proaches {cor ot^o'j thet ijc ! a A rotate- t c ar-f &s'^omo< iir-o^t 
e<3i,£f *o ^e rapcta > A *f the next '(tea iy jmcg gait Ih s even ih le. i c of- ^-f <. ^tfor n wbicf! or^iy h^J 

dfv qcnt --ciT^nf r-">o c ?u o rnothe ci ptev t<^f c 1 n r-r. h q ! b*- 1- t'<5'» 

n wf rr t <, 1 1 n t c iw<. 

r^ive \t h posit on jna vJoc y tqui- tu ict ot^ier iS in other v*o tis that iw maks not o-^ y tho divergot 
^.(..^v^^ri^nt ^< ,i = the co--we'gf»n* cr>mpon(>n! are mfl<ie sotiaf to each other. Therafora. Ihis metsiotJ of gatt generatsftri 
n ^hicitvor hftosrtonpndveloolv-ipfT'i* v^qw^iitoeachotherfsa^pect'icocampleo Jhp gart gonpn-tton n-ctho'i 
\n which oi^iy the divergent componofit is made sqoai to each other. 

f0247| Other parameters thaft the dssired ZMP r^ay be correctsd (8>ts is the sartiB as tne .irtitXMlimeruf. ro, 
east-^QfCKpiffS'top oiiya^medrooaicnrtheXctiecttontsciescftbed Acljsli> umHe u J'-wsi^ 
i,re^sed a« in t^-s '--so of c-schrqt'^t Ai i c ho > o'lx '"0<;i on ^ ict \ h i!\ -> 

[0248] h the seco'-a D r n <■ ' p 1 i^^a M ol -i ^ 

- n d caii rst'Aci be Ufa rji-tt,r s -iw po<;), & e to cc ju caic Jat v>rs c 
in savancs to prepare inerri as Friappod oats. 

[024»3 I* ss^ot'id f"rih»'- be ■■>o!ed thst the iT^a;no:i oi qait genfefattof* tnthe secoTKS fttnbodtmenl usmg the nori-linear 
Tiode tn AsearchEignarns''cjnbeu tuedtoa leariTiooei such ast^e three-matei-ia! poHtDOde {ty H'^\rjL 

ia»sriaf pom« rodet/ used 'j tt^e ftfs embodimem to obtair? lh& gat itv an aftaiytic manner Hcwwer s nee f^s ci<J!t 
cap be deteminsiJ anaJyticaliy. there is tutie adviantaqe to use such a searchir\g methoef, thas ss poo; m sffiutoncy. in 
coticiusion dyiiamic modef can be as&d. it it exhibtis 8 suflictent acciKacy of appraxmaaon. 
[0250] fr> ths tr« ©Tocsmpn! onn the -e-nti cnnbo'^-^'»T Mh-^ 5 it ^ 5- nuaiiy generated tr inewt'^the 

jp o''-d« e (iyn rirgg^it tteZMf cotre to^^mL jod ZMP generated as hecutresit 

cja t IS e-iidf - hp ZMP pro i&iomi JosireJ ZMP ^ "^ing ga'l S*"^® ™P °^ '"^^ 

^rj/ jr nq m s so t j h 51 rr^d gtn 0* stabilis it ime qart fas fiigh -rargin of statJtffiy tnsofai as 

!■-,-. .!,:.(»:.. ^.tioi^ i<! i-ontijufwci i(? Sti'ie With ihs sLippoBod tu)T>ing {|aii. 

5 J ,-,(. ^' -'>t(<>f»,-,!,:.d qenetat.-? a qai! that is differsnt qreatty from ttie steady tumm SS't 

feuptJO r «fK step 8A ser « ice th., abac t. tp vrfl tf-e ZMP cormctton amount becomes farge the J sired 
2WP r iio,! ydi cd is cjtrent tfne gsi deviates rna^keo v mm an idea t lajectoty the margin of ■'tab li y 
bee n tcvi "'-t x=^mp e if t ss attert ptsd to tu n the oo') 0 the nght t^te ga t should be getters ed to Mfi '^c 
terser f^, ^Nti height !rador->iftdr rojdc+'^c^i..scf'-r obr 1 to t fn<o thoiG«abrtiptty at thonoxt v,^ k ^ ep 
tiie deiitred 2ft/^> t ajectory f^u-? bo ^i^a o thf* o if irfrtjp '-o b to '"^m tho o" f>r o' gr i-. ty fro i t gh to -jl f i5 
lowers Sie-rirqn fsl«t!W>,a t^K? o^ot it ^ -> » o e. 

[0252] ^o thdt reast,n iti ^ j f q * cp t rv r p t 9 j t iha ^^ j 

be t3Cf}or?*'^o -o-«i«e he o^jt. c - ii ( i ! i i^ -)>tl ^ -^ov^l^S 

! « y u n g Orft irf " ri t o t 1 1 ^ 0 <^ ^^f ? 

it is sBt 10 be Close to a qatt to oe oe-^orasoo luurc 

[02531 Methods Df sto'idy ♦umirq u, 1 qt-rc <- un ur^-rtrdt t ^w^wSi h n tjevx^tar-^d 11 ^to4> ^xi,"ptfor 
4) a devfstioft beiweers the steady turriing gait and a gas Qenerated future )s itabie to increase, but caicutation .s made 
easier. 

-be le^f ^ t "1^ fi)'- ^jo'ioii q eq orJit to £,t csnd ti-o next but one times vvafkirq p^nod may b 
detarmtf-e J o\ t ! u i 1 ^ =;f>v. cr iK (E?i m i if> <;u»iofting fag coordinate system Recurrent 

times wsfK-x J^itc lirq -^t > up tj hat 1 p '-')<="d <. tfio i>uppo<« tion tfic^f 'he w,aSs«rq velrc tv or 



<dicj«t -"itto T)^ft lAhfCi fie v,t -^Kcp -^ili "^Jt b eet are moved 
Asc !hf walki^i? speed increaaeis. iho ZUP cofreottoo amount increases and the margin ot 
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sii Abisny I's i-:iw$:fed The StJinasiit! gai) (fir]ift«f?s a stiii gait without movewen! 

4; A Ua',smon,ii gs;.} may te fttidt..; or inserted t.?fweeri ;he cdrrsfit tfrrie gsiit Ai-.ti ihs steady Sgrning gsis, Ai!hcsugii 
c.ci!C.L..alion ior behav^o; pr£:tj:cSton wiii L-t' .rcnipiicated. str,cethe consttainf catidiiion (bounaasy condrtton) in de- 
wro-.r-mq Pis steii(jy {ufPing gas! baccfries (oose and strsce f biscomes pcssibls io ssf su-^^rty !nfnii-'< c-ai^ nor.? 
elossHo a deairstionejt can fiJrtt)&f enhance the (wsrainoi sj^ » ^ - - 

[D2543 : ,i KcssitHe to combiner 3) am 4) A <ji-M generason sy^JtefP of d fctj.yjd n^ite roDol ^coord^ny ii-rd 
embocjiiTient fi? tCie praseni is matje wtih focus on this. 

£0255] Fig^-f: Ui: ..s rt visw, simiiar io Figure 13, but sHowsng partially the operation, more spectfieaity, the sclting of 
ointT! sEeasjy tuffimg gatt, o; the system accorcting to the thirci 3fribo<3imem. 

i025S3 Sp;:a^.cA{hf. as itiusi-tuca to p!gure£2, the embodiment is configured in such a mmncr that tho Stcacfy turning 
ga!i IOCS jrtc-'j u-,c stjj.ias-t.i. gan, and ihst tho jrafisftttina! gait (trajisstion gait afKi indudcs any gait othcrthan the steady 
i^if-mg gad) is .nsertsci bct%^'9eri Use ctirrenl tima gait and Ihe slandstiii gai! (steady tutnifig ^it). 
[02S73 Thus, by setifng ;hroc g«tts co^nprisi-ig the current sime sait/lhe transitional gait and the slandsHif gait it 
becomss possibte to offectw-iy prevt-jit t.-^e posture divergence. Furthsf, since the gait is generated in suct> a v«ay that 
the robot can shm to Wse &i«ndstsii si.=its at any iime. it can reaitea a stopping motion with high margin of stabiJitv evon 
when a si;dden stop demand is marfe 

[0258] More eoecifcaJiy, deeming the standsiiff gait as a kinai of the steady turning gaits, the afofffssiid i^kprmn of 
steady luming gait's initial divergent component shoutd be used. However, since the bodys tnaieriai poit^t vftfocity at 
stop is 0 the divergent componsnt Is always equaf to the inverted pendulum's nrjateriai potni position, Accotdingiy, tiie 
*vs:fgont oomponem can be ftasitv obtained wtthoui Lising the aiqorlhr^ 

[02591 HKV.ng L>GS>n configured tho fwccjoincj rnarn*?^- tnfi ji^.-o L=.n.bod,r,<5ri= can genarate a gait having hiqh margin 

Su-iD.h;y ^rffi^v ara of* 'e3i-t.:7>c S-iS is. Sfrniarv lo ii^c Urp- er^soci -^^.-n; ;,nd ibe secontJ embodimen; 
[0260] As st.3terf .r, ihs .^bov-s. iho firs! to inird m^o^yr.. .v- ,-v :,.;,..rd ic h.ve systen. fgai; gs.erator '00! 
Sor gener-«tif^5 a gaa cf =3 legged mob!.;- ro.wt ■ nwinq rf^ - ■ .■ . : ;^ , ..^ity c; mcr^^ p:v ri^^^iy (yvo it-js 

{leg itnKs) 2 each oonnec^ea to ;ne oody coinprisin^ ci : ■ ,;- -.s-j .•; f.gwas & and 6) !ti;;i c^or^-sses 

rBiaiionsnip between moiion of she teg and she boiSy, ai^a a fwor rt ^.c'.-.o--^ 'cic..; •.--.■0:0 specsfic-iiiy i>ie "''MPi 'c-j"rsn! 
time gait par^meief provistonaily-determfning means (S24) for provisto^afiv deSfsi-rriining pafiartietefs of a curror-s tir<s 
gait inciudtng at least parameters detetmining a trajectory of the ieg {desired fco! posliion and postu.'-e) and^a ir^ii-'ctory 
of the floor reaction force (desired totai fioor reaction fo«:e cenltai pofrs; Daj'sotc-v (dessrsd IMP !raieotO(>')). in response 
fo a1 i«j.=ist a dSTiand (new trre gait's supporting t^g coordinate system, fjext bui one tfm© galfs'suppsrting teg ooor- 
■i.mtii f,y curreni tifrse gait psfiod. riox! tinis gatt penod. etc, S22); periodic gait parameter supposing means 
u.;-;;} i;» ., jyp'jsmj? lor laierrriining) ihi> paffi^neiers of ^ r-'-,Ti;c gait {steady turning gatt> succeeding to the currem 
i:!ris ga.-i in response ;o at etist 'he dATiand era > ■-.> r^rs-r.oisf co^^octma means !S30 S2C0-5203) for 
oofractiriij «( least ne .rov,..on.!ly de.;«. c- ■ . ■ . ; ,. . . tiic ira.^cio^ of .1- oody 

(aes.redlDoc!yp:,..iiior.a.dpost..-e-tr.ii...io.-y, . - . , . , a^nci ti-« D^r-.,nel.-r. on.e 

current time ga.t sno ttie periodic gaii succeeding ihcrs-.o tuossantiaiiy conve.'s^es or becomes equsi to a tr«iecfOfy of 
the oody »f tha periodic gait detsmined from ttia paramsters of the periodic saiE; and current time gaii instantaneous 
value detefmining .means (S20. S300-SS14} for determining instantaneous values of the current ti«re gait based on at 
iisast the cotrocsed paramoiors of the current time gait. 

10261 ] f.jfXh^r. tf sy arc configured io ns.'si. a sysiea-> rgait generator 100) for generating a gait of a legged mobifa 
1 i-.3v .iy .1! t5.,jsE a booy r.A Ann a pi^iraiity of, more preclHftly. two legs (ieg links) S each oooneded to the biJdy, 
' '^^ "' ' ' ' " -' n Figu.'cs 6 and B) ttsist expresses refationsbip between mctiofi of ths teg and 



th(?OGOV rfnci ci il'-ic: rrMO^ior force inx-.!f.- ^^:v■^■>V,;^;|> thu ZVp- ■ 
mef-ns for proviSiCjn^iiy do:erf": r , 



lit parameter provisfonf-iiy dsse 
:r.e yai) itJijfuding at iessi pa-amsisrs deiofimtviig 
trajectory of tf»e Haor r&=ic." or; ic-ic'? cifsired 



atrajecfory o? the lag i^vsv-eti foot po;. z\ vi,-;c 

totaf floor tot;ciior> fores central poir,! !iajec!ory (desiroj ZM- i;a'ectofV!)"'n r.'jspofiso to at te-.si s demand f32?v 
periodic gait parameter sirpposing mearis tS26)fof suopcs-riq ;o! determining^ t p£ir.-..r-iot;^r<; a p.^nc-ic qait siefe.-iy 
tirrning gait} sticceedins to the corram time gait in response- !o «> ie;,G! tr=e Jcrn.-^nd periMic gai! bcu,nd.^,'y .^i™-- 
compoi>or,t Oetermining means {S2S, S100-S ■06ifordete.m>;„r,g ,j peuodic gait t>ounoarv divsrgeff co-npor^.-^r., iin^tVai 
dis'ergftn; ^^ornDonen, of the sti?adv tiiming gaif) the! is a value ir^fiiiatmg s otvergent component at gart faotsndary when 
Porusvioi 0, cc-iy oi sne p«.r:oc!ic g;'.! is ,-i?i;5'o>rimated by sn>3 dvnamic rr,ode!, based on the parameters of the periodic 
g.^ii- c ^'r-.?n! im-is gait oar.:,f^.v$,- --or^eciing means .,S30 S?OO S208) for correctir^g the parameters of the current gail 
such tr^at -ns oivergenl con>por^en; isscomes equal io or becomes stiDstantiaily etj-ja! to each other at te.m-dnai of ttte 
current gau (terrrimat divergent conponer^i} generated use of the aynamic rr>odei; and current tin^ gait instanta- 
r>eo^s value oetermining mean.. (S?0, SSOO SSI 4) for deterrr.:r.ing >na!antaneoijs vafues of the current tims rjait based 
on at seasi the correcited parameters of tho cLirrent tinse gait 

[02621 f^nrtber it is configured tha! a transniona! gaii is (f.&ensti between im curfSHi time gfj and m ssffodic gafE 
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siffxeecJsng thereto. 

f0263] Piiriiiei, iE •& coi^figured if.&i the transiiionsi gfrf inr.ii.^o,-. ■? ^i,T^r;=-;': c;^ ; 

[0264] f-U!!hei i^-oy a-f; ci^n-igu'sci to have a sysiem igf,:. v-' li- ' t :.-,r:-:sraUr;<5 a gstl ol a SsfiSed rrwb^is 
robot 1 h::iVi!ig fit i.;ast a boc-y 24 snd s piutaiSy of. morti c v ic-^i ; ttnks,} 2 each connecieci to ihe hociy, 

s ;»rnpfis:rtg leg •«:scik..n ^ofce caicuiatin;) wMria : .?Mr- c^t.^-io: ?0G S20 S305) fo; caicjlsstina a leg reficMion 
r...K^,>. ii-iots.^ speoifitvi'iy. a seg 2MP (ZMPff^ei) Siio :t i " -^s ..-:sm ■y:\^ \n&'\\iii force) ol \ S foi. ^ m . >. !v 
.(idLiceci b>' ri frsolk'E; o! Ihe without ciepefiding ot> oshaviuE of ilstj btjdy, snvsrieci pe^trfuium fnociel supfjotsing poinl 
posr.sc-i taiculatinf; :^i&.ios iS20, SS08) for calcukling aposition of e suppo'lincj poijiS cf ars fnvertetJ pencil ium ^ZMP- 
psnd) th<3t describes dynamic behaviof af ihs body, from at feasJ the cateuiated isg reaciion force and a desired ftoor 

to rsaclion force (iiiofs fcpeciftcaiiy, s rfesired ZMP): inverted psndutiim dispiacemeot catcuiftting means JSSO, S310)for 
caicuiating d!&p;C;Ccn;orii of the sjivoicd pcnduiutn: tnorc picciaaiy, ths inverted pandijium's motarisii poin! p^jsilori 
{iriveried pondu^vim'.^ l-.o!wo'it;jt posir.on xb; Dascci on iit fOisS trie; c:i!ouiatcc position of the suppon^ng poif! of 
inverted De-rdu-u^n, bi-idy posiSion c;*tekH;>ra iT.&.int (boay ::0£ ;i0'i deteminator SOr;. S20 S31? S5-i for caicul.Jting 
ocsiitoii of the bc.oV n^or^i xa-ccM-.-n^^ a body's, iicn^aniai ooslt'ori bast"^ on a; tsast \h& c.^lciiijsfod rasplacemeni of 

!S ihe J!v£ri£-dponc!ui^^^. and ga.i sener?,!i;ig rr^aani (S20 S;ie'.>S3^4 gsit ge-eMtoriOO> for qent^raiing Sigaitbaesd 

[0265] Ti-isy .arS' t-.i^r ;tO!i'f?:i To have a systeiw {gai} g&neralor 10O) ici; gerseraii.^g a g^si! of a ieggsd rnabite robot 1 
h«>/;n5;;iSiG;jstabody2-'iana<-3pia!«ii!yof, more preciseiy, two tegs (isQiinks) 2 each connected to the bcdy.compftsmg: 
istj mp caicuialing tT^ean.s (ieq calcuJaior 200, S20. S306) for calcutating « teg 2MP (EWPpend) that is corre- 

20 spofiding it> a ZWP ol the leg that is a pseudo value oS a tesuitant force of inertia! force and gravity Inauceci by amotion 
cf the isg, withoiiS depersdlng on behavior o; the body; inverted pendulunri mods! suDporting point posilioti caicuiatlng 
njear-s (S20, S308) for calcuiating a position of a supportincj po(nt o! an inverted pcfiduium {ZMPpsnd} that dsscrtb&s 
dyna»r.ic behavior of the body, from at teastfne caicutated ZMP ar-.ci a desii&r; 7.U.P, inverted penduiLun displacefDent 
cafcuiating mear^s (S20, SSlO) for catoutating dtspJacem-ar:! -.i-u:- nvcrtod po'^cfuiun^, mars specifically, the invejtsd 
pufidutum'smaterls! point position (inverted penduiu'r-s. nor./on??. poj.ii .<.r^ c-.-ij.,?c; on at leasttiie calculated position 
of ttjo supporting point o5 ths inverted psnduiurr- ooay position ca cv..v,:::Ci -^e-::if (S20. S312. S314. body position 
determtnator £02) tor caicuiatmg a position of ft^s bo-^y casoc; j-. --.a ioast oaicul.atsd displacement of tlie inverted 
psndtjtur-v afici gait gensrattrR) ms&f^s (S?G, S300-S31 4. g&il ge^-ieratoi 1 00) foi generates a gait based on at feast 
the caictiiatiJd posttion of t!i8 body. 

33 [0266] Pyrthst. it is configured that the inverting pendtrttsm madef suppoiting point caicuiating means catcutatss the 
supportit^g pomt of tne inverted penduium {inverted penduium's horizontal position xbj by subtracting a prodi;ct obfatr^e>(3 
by muiiiplytng the leg ZUP by a second cosffKient mfeet/nttota! from «5 praAicx obiaineo by rrwitpiyinQ ii^s; dasired 
ZMP by a first coefiicfent mtotai/mb. 

[0267} Furth&r, tney are configured to have a system (q^ gar-ijra^O' iOO! tor geDeESiing a gaii of a isggsct mobile 

3S rjbol 1 iiavirtt; at isjast a bociv 24 and a ciuK-jlity of. inoi c- pjc.-ci'.^clv. iot;^ (teg links) 2 each conM;;;l«d to Uie body, 
cc3!T:prisina; a dynsmir. n-odei havif^g. a leg fOiicl^n ft-i.' . .■.ic.;....-.j rnea.r.s (is;g ZMP cateuiator £00. S20 S30G) for 
ciilcuiating a i-ag reaction lotce {feg ZWP {ZVIPieet)) tna; a rss;;;;ar:. force ot inertial force and gravity inducecJ by a 
not an of tne !sg. without cisp-sndinq an ^.c.thsaor of ;he body; invei-ted pendulum modef atippotting point position 
caicuSatiriy rnaar-.i ;S20. S308; tof caictiiatmg a position ot a suppo'-tsng point of an inverted pendulum {itivertsd pen- 

■io duttin-i'6 ZfvSP (ZCvlPpond); tnat describes oynamic bahavioi ot ino body, from at (oast tho catoutaJcd (eg reaction fofco 
an« a desired fSoor reaction force (desirscf ZMP); snvsrte^S p&ndulum dispiacsmen! catculatinq means (S20 531 0) tor 
caicuiating dispiaficrnent of the inverted penduium based on at !«sast the catcaia-ed posit icm of th;? su^porTinq point of 
the inverted pendutum. more preciseiy position (inverted penduium's hortzonxai posiSionj-. antj uorfy position c^icti-ijtin^ 
means (body position determinator 20?, SSO, S312, S3U) for caicuiating a position of the borfy (i:!'^dys t-.or:2oriSa! 

*s position) basfFO or; at least the saScaiated dispiacsmsnt of the invertetJ penduium; cuv'^-.-^' !in-:e gait p^rfifr^eter prov,- 
sionaily-delerrnining means (S24) for provistonatly (ietermining parameters o? a ciirrc-ni time gait inciucsinci at loisst 
parameters deterrTtinifig a iraiectory of thS ieo (=iesirecJ foot position aniJ posture Irajcciory) an:i » ttAjsctoiv of the floor 
rsacilori tofce (dej.reci -otal floor reaction force cenir;?' t'c^it ;r«isciory (aosired ZMP tra;sctory)). in response; lo a! least 
s rfemanG fSS2!, penccsic. gsii parametc-' sup^osina mcaris !,S.?5; foi supposing tht? pat^miL'tors of a periociic gait 

SO (atsiidy tijrmng gaii) Biiocasjdii-jg to ths current tij^is pail in response to at iesist tho demand, panodic. gait boundary 
divergent component detatmining means {S?8, S100-S106) for determining a periodic gait bounda!^ dtvergent com- 
pones^tttiat is a vaiue indicating a divergent component {steady turning gait's initial divergent corriponent) at gait bound- 
ixrsj wtis?n behftviof of the body of the ponodic qai! is approxiraated by the dynamic model, based on tije pammeters 
of t^i^ periodic gait, currers! time jjai! 0":rai-ne!-3r :;of<fctinq moans 5200- i.S2C!8} los correciing the parameiars of 

ss t^e cijiranl gaii stir.fi iti'it 'he divergt^r-.! -i -r' -o'iy-v :-.o:.c--v.;.- s;-; to or t:.i-?oom«?s substantiailv equal to sacb other at 
tamiini;i .s; -f-.o cuoani gaU icuirijnt t.nic- ^■'.■.\ < ■<.^:.>-'\--- oorriporienf) ganeratod witn ijseofthe dynamic model; 

and current timo gait trsstantaneous vftiue determiniriq means (S20, S300-S314) tor determining instantaneous vatites 
Of the currettl mm gait basea on al iesisi tr* cortectecf parameters ot aw outrent time yisit. 



26 



eP1 361 027 A1 



f £ t J o xisrre-jt car $d5 ify d of he c 



Co ,d, or 1. s^.o^tci t,e deuvr. d - u i i c pi a, q . ^nr^T .e . - n;, . • t M j . o'v 

v,onrfij,,off b) n shot;tc! not be mm&nced by the rnoEion o! Uie t)ody rep!essrli!->q point ' 
Conoiiton c! The accuracy of approximation of a stmpftfied mode! should be su!fic©n% high 
CondrtFon ft shojfd be oor,t,ni!ous as mt^ch t^os^bfe (sc as to mahothe body acce em'.on ci,«< nuous ) 

ITV^ .f.n""^!' Condition* a) and b) are those for facliltetmg mc .oredictive csteufatbn. fr, the emb«dSnon*s 
3S and £ ^'""^ ^''^^ ^' '"^^ "'^^^'^ ^ ^ ^^'^ equations (eqs! 



leg's toss} inertiai force fnwT?ent about point P mfeet* {^MPfeet - xp) 

SSI fl^pf S"""; ^ T f T'"'- ^^"''^ '^^"^^^ ^'^'''^^ acceieration vector afest is obtained, 

afesu in Eq . 06 !r>d« the feafs center of gravity's vertical-directional acccteration .ecior that is corfsspondm 
!o !he vector aleet with its X and Y components are made xero. fesponang 

af3isfc*(fTMSup*d2{xsup)/dt2+^mswg*d2(xsw9)/dt2) / (fnsiip+mswg} 37 

[02733 Since the degrss of adjustment of ~ q. 36 is higher than thai o? Et, < c 

imaston. in Eq. 1 for cafcaiating the feg's tosal inertiaf force moment about tfis point P 'ti^e iem 
acceleration can be mtittipijed by jbe constant as tJisciosed, Althoucjt) the equation is changed to oe incorrsct in *he 
serise ot aynamcs, insoTar as the aiXiJracy of approximation of the simplifioti modef is enhanced, it is possfeie ' ^ 
P274J Then, the setting of ihs poini of aaion P iwifl be comtnetited. 
[08783 The point of action P may be set as fotlows; 

1) to est the point 0? action Pattf if wiq.n r.f •!!..»„•„,;..„),.. 
tarmined pomt • hereabout. 

ttme Oust before the currem time) gait's supporting iey .or rd.r-atc-. sy^Mem' o: :^::. 0, a p.^datr:.oiined point there- 
about to Ihe current time gait's supporting (eg coorciina.o ^ac^'^ „ o, a a-cdoic^^ir-cci po-r,. th4about 
3) fo sef ttie poin! of aotion P such that it bacomes oq^ai lo ttse prows,onai desirea Z.^-ii"^ t.^ajsc^orv 

[0276J Their charactetistK: features will additionatiy be commented, 

£02773 As regards 1}. sinc^ t^e point o' ,.rJion P beccrries discontinoous rafatve to the teg positioo {i.e. becomes 

Sco^rf ^'"^ '""^ """'' "''^^ ""'^ "^"^ °" '"'^ ^'^^'^^^ '^''^ Mvantageousiy 
rtin-if.- " - ■■s-oft!ifiiiou*wh3n Viewing from the absoiutecoor- 

:TZ T'"?' ■■' '-'f sy&-r- „ , ■ ... y. i^e two- Icq pe.-o<j where the feet acceleration is 

roi so jarge, !n« magfiituds of rftscommuity wili yield iiltie pjoijier?^ in waiking 

{8278] As regards 2), its accuracy of spproximation is better than i). Further sincx^ tf>c ocuH a-;.on ^ br>~oirf>s 
conlinuous reisfive to the leg posiiior.. ZMPfeet does accordingly become con.,..cn;c -ei^^jive tc. the leg po.>t,oo '^^ 
[02791 As regards 3) tts accuracy of apptoxsmation is more i.mprovsd tha'i 2). Farther, like 2i. /MPfeet ts c ont,iu«..s 
reianve lo !.he ieg pos'tion. 

S! I^T ^-'^ '--'^''^ '^s"^'^^ ''^^ will additionally be cemmentsd. 

10281 J t he too: nv.;eti«; pc-.-n; ■-■f.jscEo'v s fi mhoototy determjpeo from s=s foot motion parameters Xhi- ttc-. x tory 

0, tne .00! pcsit.on :jric; »c...^-u!ff eo be d,;vrn;r:-.g t^>s too! matenii- point fraieciory nseo not oe oo.j^:1c 



system ot tjie current t.nif yart a pieUe- 



o5'?:rn;airig the fool materiai pos.'-f 



nay be a E.'3;eciory tr; wh:cn the fooE is kspt hori«.ntai. Unless the socu.-«cy is degraded greatiy, the amooni of ;oot 
t!!:ing or SO>Tifj simiiar 3»(»rnet<?rs may he aH.oroci in ir^e trajecwry. 
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[0282] Tha !eg msiteria! poinJ ?Y»ay bs sei as tofiows: 
1 ^ t>:> S85 «I a predstsdTiSneO point m tt»e Eooi: 

2) to set a colnt stisnsd verjicafiy Stom tt;s sforesasd ptecleterfmnflci point cy a pfescnbed distaooe; 

3) !o s>^t fi i:!!ur:?Jtty o! poinis if* the fooJ The foot riiay set with inertia.. 

f02S3| Any o! she above cat; ^ais&iy the a(otesa:ti Condilian b). 

(02841 Addstionaily C0!T>me:i!i:^c} on serting of the nwif^risi! point offsst ci me body and iog. (i the fv^aicMa' po^=it 
offset valuas of the body an<J leg r?i3y be set to fixed vaftje*. there wiiS yieid i^ttle problem. Aitsrnative:y. Uv.iy n^c=y 
corrected in fespo>^se to the gaS parameters m ordsf io decrease ihs mcdaiir.c) errof M t:is ce^^tsr of gravity as l;n:e 
prjsssio. A!;rou9f^ tSK- hon?unEc-ji positiooottho invcnoa p^-^dUorr-. is rrvsdc corrcf-ponding io tno hofi^^onUi! posi^on 
ot iho bJOd/'roprcscr^Si-ig poinl, n may aijcmativeiy be ri^adc so tio corrcspcriding tr. the ccr.toT o; g^avitv ;ho robot, 
a'-, f- whfiift or tti the cer>tf?r of qravity of tt^e roliot sxciiiciing isgs or a ieg 

f02851 AmoMcr. i'^c. ivjighi of t>ie irivsjt'Sd psndutum nsy be cha-iijed m rssponse io tiie gait paramsters. it ts prsf- 
e^f-bte to se! thf' ;.■!'■* ;o <;.x >fl uf? duritu-; a sfiort penod of tine (such as during cne waking siep) in order to 

m2RB] Acc' "ton .fiy"(.c'r '^e^t ^-q on i r ouifstio!^ of the divergon) corriponent induced by the tsg nr^otion. the divsr- 
gent component induced by the teg n^oiion may be (jelcrmtned direcliy from gait pararjissers ir, an approxin^mon 
;^?onor witrioot geosrating the leq motion at evejy control eycla. For example, by approximattng that ihs; ie-s ZMH 
SI ari avor^ige value between the feet's center of gravity ai the initial of the gait and that at tf^e torntnai c '-.hu g.-^.t dur ng 
one step watking, a product ob-ained bv ■T^t-iStipiyinq she average vafue with H(1 ,. T) will be a value ii^.ai approximaies 
a vslue Qbtaiied by oonvoitins ths div«:r<jftr:! conponent inctucec; by itie feg moiiOR by into in^pi;lss at i (rr-:» a. 
r02871 The terminai dive'geni ::cn^v,'-iarA mduot-Jd by She ieg motion <£ expressed by a iunctr- "^'^ 



). Accordingly, If rrsapped dsua thai ihows th& 



.^l..;,onsh:p beiween the a.:: r.r..r.., ..... , . . : - . :■ - -'^^i d.vergont corr^ponent mducea py !he leg notion. tt,e volume 

ot c=.iciifi»tiot. <^iii bo ctoorc...... . v: ..'....r. . ■ •:.:^p.-^-^-!y ^^^'^i-^'^fy is nesded Either method can be "t.iaed 

r02»81 ii will be possibic to co-r^btro Uwse atoreia^d aisernasivss together. For exarr.pifi: ttie metnocs of (eg m? 
catcuia^ion to ca^cuiate the Z6/IF cor rection amouni {in predicting future behavior) and the method of teg 7M P calcuiation 
to caicjiate ttie instantarieous vaiue in tfie cvirrem control cycle need not be strictty equal to each otner Stncs the 
inf'beri'^e ot the iritliaf divergent cotr^ponent is taken into account wh8r> cateaiating the ZMP corrscticn amount, i! ihe 
divergent component deviates by a smaSi difference {occumng between them), s correation wtil be made tc st;pprsss 
the dWergencs when conducting gait generation in the next v*ail(ing step. r 
r0289f "it shooid be noted that, although -he gait is corrected or ciianged when the taite t ts ^ero tn bi 0 in the now 
'ha- of Fidure 1 ? in the first srrjDodi^i^ent. ths gait n^ay be corrected or changed at any time omerthan that, if doing 
so i' s«ffi4'< tne currem i^rf-e is des;ri>ed «s the miliat time of the current time gait. In oUter words, it suffices if a 
o"r-ld of tf^e curren; t.r^x^ vj^ii' =«ncKd iron the c.urrcrit t=rne to the current tin^e gait's termirtai. 

[02901 IS should further be noted that >h,, block diagram i!li;strai«jd in Figure 6 may be altered insofar as eqoivafent 

[02911 ir. the foregomo srrbod.tpents, attnoogh the presetjt lr.ventioh has been described wUh reference to a btpea 
roboi, !ho present invention can also bo applied to any other logged mobile robots having tegs of fhree or more. 

IMDUSTRtAl FIELD IN WHICH THE SNVENTiON iS APPLICABLE 



[02921 Aecoi-dir-g to p'eseni inv.-ntion V^.S't, s prc.v:C!-o ^ ■/r-.c-.-si-j. s,-: 

hasthij dvnaniiG model s>:pressfng thn rEiWtio!isnip be!v.'-.«;n ihe tw;i;f>n of !ho budy , . . 

„, .j,^^, gj^jj paranetars irciuding ai feasi pafa-neteTS that de-termtne leg traiectcry 



ic.'Qged nobiis robot that 
floor !-a,?ct;on for^e. 



andprovisiofialiy detanT!!ri8Sthecut.''enttirtw ga!tparanetCtst!'Ciuai,!gcn twdsip" 
'ndth«-> like r, 's&r>ons-2 io a rti^ntand corrects Ihe cursoniDtnegait aamrmert such th3ttt-,5 boay trajectory (dstsrmirted 
bas"d on tne dvnamic 3odai and the parameters of the cojre.tt lime gait and a persodic gait succeeding thereto) 
sudliant^^iiv converges or t^econies eqoai to a body traiecioty determined from ihe parameters of the periotJie gait, 
f-nd dei-^ft^^ines insiansaneous values of the current tisflo gait based on the correcied curren! time gait parameter. With 
th" system can generate, freely and on a reai-ti-tie basis, a gait of any stiide, turning ;snc}le and walking per;.;xi. 
induduiq ihs fiocr reaction force acting on the ieggerf mct.iis ropot lhat satisfies \he dynamic E!q!jtiii:.rium condtiion, 
[0293] Further, tng systerr! can generates a gait in such a ir.nmer tha; the displacen-iorn «r.d vair.r,l^^ of rasch sobot 
pan are continues at the boundary oi the generated gait and Ehat iju«;esding thercio. can generaie a gaii ihar if. mgn 
in the margin ot stabiiity. can predict fulure behavior of the robot to generate a gatt such tbal r^o disadvantages sucn 
as posture divoi^ence occurs. Furthem^ore. the system can efisure real-time gaii generation with tilgh spseci caicuta- 



BP 1 361 027 A1 



Ciaims 

1 . A system lor generaiing a gait oJ a legged mobm fobot having at feast aSjody am a piuraSy ot tegs sach conrsected 
to ;rie bocy, cofTsprissng; 

i) a dynarrssc mode! thai expresses reisUcnahip tselween motion of She teg and the and a Roor reaciion 
force; 

t}. Cvirrent time gait paramster piovisionaliy-determining means forpiovisiortaiSy dsten-niningt paiameters of a 
ciinmt tin-se gaii inciadrng at least parameters deteirniniog a trajectory of the teg af»c! a trajeciory of the floor 
rcacStors force. In response to at least a derrsand; 

c psrsodic gaii parasTicter supposing means forsupposing itjc paramotors of a poriodio gait suococdmg to the 

current Siinc gait in response to at Seas; the demand; 

d current lims gait parameie? corresiing nmans for correcting At (east the provfSionaity datstrfsfneci parametets 
o! the cufpsftt time gait such ihat the trajscloiy of the body determined based on the cfynarr>io modet and fhe 
parameiers qs the cunent time gait and the psfiodk; gait succeeding therelo substanttaily converges or be- 
comes eqiisi to 3 trajectory of the body of the periodic gait dstenntfsed from the parameters of the periodic 

Ejait: and 

e. current time gait mstantaneous vgioe determining means for deEermining instamarjeous vaiues of tSie currerjt 
time gait bassd on at ieast the corrected parameters of the ourrerrt tirrie gait. 

2. A system tor generating a gait o! a isgged mobiie robm havltjg at ieast a body and a piuraKty of legs each connected 

to the body. CDmpnsirtg; 

a s (iyfjisruic model tiial expresses reiationship beiwesn motion of this leg and itss body, and a floor reaction 
totes; 

b. current time gait parameter provisionaiiy-dGtonrining n-icsns for ptovisiOfiaiiy deterniining parc-amijiefs of a 
current tifrie gait indoding at least paramsters detstrriining a trajectory of the ieg and a trajeciofy of the floor 
reaction force, in response to at isast a demand; 

c. periodic gait parameter supposing means tor supposing the parameters of a periodic gait succeseBng to the 
current time gait in response to at taast the demand; 

d periodic gait boundary divergent component determining means for detemnining a peitodic gait bour^dary 
divergertt componerrt that ts a value indicating a divetgertt component at gait boyrtdary when befiavior of the 
body of the periodic gait is approximated by the dynamic modei, based on the parameters of the periodic gait: 
e current time gait parameter correcting means for correcting the pssrsmetsrs of the eofrent gait suet; thai the 
d:vt>icie!t! consponeni beccmas equ^it let or becoinea sutsslatUiatiy equa; Ic cacn other at SerrF)in«l c( Sise current 
gjiit generated wiih use of the dynsinsc modet; anc 

f , ciirrent tin-io gait instantaneous valine determining means for detem^ining tnatsntaneous values ol ti^se current 
time gait based on at least the corrsctsd parametets of the cijrren! time ga:t. 

3. A system accorcting to claim 1 or 2, wherein a tsansitionaf gait is inscttcsS betwcesi tfie cyfrent jimc gait and the 
pertodio gatt succeeding thereto, 

4. A system according to ctatm 3. wherein the traositionat gait includes a standstiff gait, 

s. A system for generating a gait of a teggesi raobite robot having at least a boc^ and a plunaf isy ol legs each oonnected 
to "he body, cornpriSing: 

a leg reaction force calcuisting means for calcsjiating a -eg reaction force that is a resuftant force of mertia! 
force and gravity induced by a motion of ttte icq. witiiou! depencfing on behavior of the body: 
&. irtvertsd penduftim modei Esjpportirsg pcirst posttion calculating means for oaiculattftg a position of a sup- 
porlint; point of ari invorted penciyium !ha! describes dynamic behavior of the body, from at Jeast the calculated 
i&Q rivacfiofi tfifcf; arid a destred floor reaction force; 

c m/ofiGd ponauhim ciispiacemsn! caictiiatirig -neans for caicufatirtg displj-cemsnt of the inverted pendufym 

l.vifced on rtl ie,=j3! the r::=t-;:;)|,4'8d f.'':?;tion o- the suijpcstttr-g pofr;! o- fhs inverted penduitirn; 

d t ;cy >^cs t 5f c-ic , ^ „i -O' r rooV based on at least the oafculated 

e o^n:\ g-3!\3!a'':r\;i n-eans ior c^erioi^ung a gait btisod on at ieass tiie caicuiated position of the body 
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to the bodv, compt-ising- 

a 7V!{- c cuidJ ng t in ' t ^ U o /M i l € p-^ ^ i Z F f 

oti o»t!3Viot o! she fcfxiy; 

D, invtrtt,<3 Pt i<ij!um iT^cs f.p Ui j ssf f. on ifc dt ig meins fti hIcosmj i 
pcj-tng^foi JO rfsitnvt't&op nd iviitt wtde^ ubfsdvr»Tt!ceehavof of if-njb jy fr^m? 't'ii «c=*c i cJ 
ZMP and 8 de&imd ZMP: 

c ^«e.ft«ti '»o"'<yf' w dfpptef^f'-nmt Ci=i!ct)ia*"?9 -fieans tor calct-latfoq dtsntacement of tha iwsited penrfuturm 



f-f, St 1 cn '^tT'ici r<.»n nonr (J r by subt «t 1^34 Dfod rf obtAoedby 'no "^ivi^ith is.^ ?\ uy 5 
>o'- i c f <-nn otn ) f ofctainecJ by >n tKtp y tig ihe desired ZMP by c- ft coclioont 

8. A<;ystt;r t g ) ^nji ^teqqf^cJ mobile !o&otl"'ivi'>g at fsast a body antS a pitjrality of tegs each connected 
to me booy. con'>»i'isir.cs: 

jfifj f A t o fo (^i i }<:< t 'i ing a leg reaction force that is a resultartt fores of 

u t dt Kt. ^ind qra^ ly ird o by !■ t it ^'^t^lO^;! depending on behavicr of the body; 

wc tcr" penduiun r-coe! ifptr f ;a«uiaiing means for caScuiating a position of a sup- 

potijo'- or (mertcdpencijlun ^h^stfescrbosovn micbehai/tof of the body, from at least ttecasicuiated 
ieg rescUQf! force and a tJestred ftoar reaction foice; 

snvsrtetS Denduiurrt dispSacement c^ulatiftg means forcatou!a{tng<!tsp!acefneRt of the invetted pendu- 
ium based on at leasi the catcuiated posmon of the supporting point of the inverted pendufum; and 

body position caicufaling neans fot caicuisting a positiofi of the body bssed on st teaai the caieuiatsd 
dtspiacennent of ihs inverted penduium; 

fa. ciirrent time gait parameter pfovisionatiy-detemiining means for ptovislcnaiiy dejemiifjing paramet&fs of a 
wmnt tiftie gait inciudlng a! least paramaiers deiermirstRS a trajectory of the leg and a {rajectory of the fioor 
teaotion iofce, in laspor'ist! to as ieast a demaod; 

c , periodic gait pat asneier suppos Ing mea rts for sopposing the parameters of a periodic gait succeeding to the 
current lima gail in response to at l-sasS the demand; 

d csricidic gait boundary cisveiger.t component doiermining means fot detenmining a periodic jjait boundary 
divergent component thai is s vaius indicaling a divetgsnt compontsn! a! gsii boundary whan Seitavior of the 
body of ti-io periodic ga-i is appf oximatod ky the dynamic rtiodel, based ors the parameters of tho periodic gait; 
e, currentttme gait jjaramstar ccrreciing imeans for correct ing the parameters o1 tiw cui-ient gait such that the 
divergent componem becomes equal to or bscomss substan-iaiiy t'quai to each other at terrrvinat o! the current 
gait generaied with use of the dynar«ie model; and 

f current lime gait instantaneous vakie deiermini'ig means for riet^rrriiRtng instani aneous vaiuss of the currfsn! 
time gsft based on at feast the cortecietJ perstTietai^, o? the current time gait, 

§, A system accordfrsg to any of claims 1 to 5 and 8. wherein ths floor reaction force indudes at Isas! a ZUP. 

10, A system according to any of ciaims 1 to 8, vifterein shs inverted pendutijm is a linear mtJdc!. 
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FIG. 3 
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FIG. 6 
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FIG. 7 
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FIG. 9 



ZMPjmd-fli) 



ZM?p«>ir-fl:i-nAt) 



39 



EP 1 361 027 A1 



FIG. 10 
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FIG. 11 
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FIG, 12 
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FIG. 13 
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FIG. 15 
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FIG. 16 
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FIG. 17 
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FIG. 18 
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FIG. 20 
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FIG. 21 
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FIG. 22 
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